slirp.c 45.3 KB
Newer Older
B
bellard 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * libslirp glue
 *
 * Copyright (c) 2004-2008 Fabrice Bellard
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
P
Peter Maydell 已提交
24
#include "qemu/osdep.h"
25
#include "qemu-common.h"
26
#include "qemu/timer.h"
27
#include "qemu/error-report.h"
28
#include "chardev/char-fe.h"
29
#include "migration/register.h"
B
bellard 已提交
30
#include "slirp.h"
31
#include "hw/hw.h"
32
#include "qemu/cutils.h"
B
bellard 已提交
33

34 35 36 37
#ifndef _WIN32
#include <net/if.h>
#endif

38 39
int slirp_debug;

40 41 42
/* Define to 1 if you want KEEPALIVE timers */
bool slirp_do_keepalive;

B
bellard 已提交
43 44
/* host loopback address */
struct in_addr loopback_addr;
45
/* host loopback network mask */
A
Anthony Liguori 已提交
46
unsigned long loopback_mask;
B
bellard 已提交
47

48
/* emulated hosts use the MAC addr 52:55:IP:IP:IP:IP */
F
Fabien Chouteau 已提交
49
static const uint8_t special_ethaddr[ETH_ALEN] = {
50
    0x52, 0x55, 0x00, 0x00, 0x00, 0x00
B
bellard 已提交
51 52
};

53 54
u_int curtime;

55
static QTAILQ_HEAD(, Slirp) slirp_instances =
B
Blue Swirl 已提交
56
    QTAILQ_HEAD_INITIALIZER(slirp_instances);
P
pbrook 已提交
57

S
Stefan Weil 已提交
58
static struct in_addr dns_addr;
59
#ifndef _WIN32
S
Samuel Thibault 已提交
60
static struct in6_addr dns6_addr;
61
#endif
S
Stefan Weil 已提交
62
static u_int dns_addr_time;
63
#ifndef _WIN32
S
Samuel Thibault 已提交
64
static u_int dns6_addr_time;
65
#endif
66

L
Liu Ping Fan 已提交
67 68 69 70 71
#define TIMEOUT_FAST 2  /* milliseconds */
#define TIMEOUT_SLOW 499  /* milliseconds */
/* for the aging of certain requests like DNS */
#define TIMEOUT_DEFAULT 1000  /* milliseconds */

B
bellard 已提交
72 73
#ifdef _WIN32

74
int get_dns_addr(struct in_addr *pdns_addr)
B
bellard 已提交
75
{
B
bellard 已提交
76 77 78 79 80
    FIXED_INFO *FixedInfo=NULL;
    ULONG    BufLen;
    DWORD    ret;
    IP_ADDR_STRING *pIPAddr;
    struct in_addr tmp_addr;
81

L
Liu Ping Fan 已提交
82
    if (dns_addr.s_addr != 0 && (curtime - dns_addr_time) < TIMEOUT_DEFAULT) {
83 84 85 86
        *pdns_addr = dns_addr;
        return 0;
    }

B
bellard 已提交
87 88
    FixedInfo = (FIXED_INFO *)GlobalAlloc(GPTR, sizeof(FIXED_INFO));
    BufLen = sizeof(FIXED_INFO);
89

B
bellard 已提交
90 91 92 93 94 95 96
    if (ERROR_BUFFER_OVERFLOW == GetNetworkParams(FixedInfo, &BufLen)) {
        if (FixedInfo) {
            GlobalFree(FixedInfo);
            FixedInfo = NULL;
        }
        FixedInfo = GlobalAlloc(GPTR, BufLen);
    }
97

B
bellard 已提交
98 99 100 101 102 103 104 105
    if ((ret = GetNetworkParams(FixedInfo, &BufLen)) != ERROR_SUCCESS) {
        printf("GetNetworkParams failed. ret = %08x\n", (u_int)ret );
        if (FixedInfo) {
            GlobalFree(FixedInfo);
            FixedInfo = NULL;
        }
        return -1;
    }
106

B
bellard 已提交
107 108 109
    pIPAddr = &(FixedInfo->DnsServerList);
    inet_aton(pIPAddr->IpAddress.String, &tmp_addr);
    *pdns_addr = tmp_addr;
110 111
    dns_addr = tmp_addr;
    dns_addr_time = curtime;
B
bellard 已提交
112 113 114 115 116
    if (FixedInfo) {
        GlobalFree(FixedInfo);
        FixedInfo = NULL;
    }
    return 0;
B
bellard 已提交
117 118
}

119
int get_dns6_addr(struct in6_addr *pdns6_addr, uint32_t *scope_id)
S
Samuel Thibault 已提交
120 121 122 123
{
    return -1;
}

124 125 126 127 128
static void winsock_cleanup(void)
{
    WSACleanup();
}

B
bellard 已提交
129 130
#else

S
Samuel Thibault 已提交
131 132 133
static int get_dns_addr_cached(void *pdns_addr, void *cached_addr,
                               socklen_t addrlen,
                               struct stat *cached_stat, u_int *cached_time)
S
Samuel Thibault 已提交
134 135
{
    struct stat old_stat;
S
Samuel Thibault 已提交
136 137
    if (curtime - *cached_time < TIMEOUT_DEFAULT) {
        memcpy(pdns_addr, cached_addr, addrlen);
S
Samuel Thibault 已提交
138 139
        return 0;
    }
S
Samuel Thibault 已提交
140 141
    old_stat = *cached_stat;
    if (stat("/etc/resolv.conf", cached_stat) != 0) {
S
Samuel Thibault 已提交
142 143
        return -1;
    }
S
Samuel Thibault 已提交
144 145 146 147 148
    if (cached_stat->st_dev == old_stat.st_dev
        && cached_stat->st_ino == old_stat.st_ino
        && cached_stat->st_size == old_stat.st_size
        && cached_stat->st_mtime == old_stat.st_mtime) {
        memcpy(pdns_addr, cached_addr, addrlen);
S
Samuel Thibault 已提交
149 150 151 152 153
        return 0;
    }
    return 1;
}

S
Samuel Thibault 已提交
154
static int get_dns_addr_resolv_conf(int af, void *pdns_addr, void *cached_addr,
155 156
                                    socklen_t addrlen, uint32_t *scope_id,
                                    u_int *cached_time)
B
bellard 已提交
157 158
{
    char buff[512];
B
blueswir1 已提交
159
    char buff2[257];
B
bellard 已提交
160 161
    FILE *f;
    int found = 0;
S
Samuel Thibault 已提交
162
    void *tmp_addr = alloca(addrlen);
163
    unsigned if_index;
164

B
bellard 已提交
165 166 167 168
    f = fopen("/etc/resolv.conf", "r");
    if (!f)
        return -1;

169
    DEBUG_MISC("IP address of your DNS(s):");
B
bellard 已提交
170 171
    while (fgets(buff, 512, f) != NULL) {
        if (sscanf(buff, "nameserver%*[ \t]%256s", buff2) == 1) {
172 173 174 175 176 177 178 179
            char *c = strchr(buff2, '%');
            if (c) {
                if_index = if_nametoindex(c + 1);
                *c = '\0';
            } else {
                if_index = 0;
            }

S
Samuel Thibault 已提交
180
            if (!inet_pton(af, buff2, tmp_addr)) {
B
bellard 已提交
181
                continue;
S
Samuel Thibault 已提交
182
            }
B
bellard 已提交
183
            /* If it's the first one, set it to dns_addr */
184
            if (!found) {
S
Samuel Thibault 已提交
185 186
                memcpy(pdns_addr, tmp_addr, addrlen);
                memcpy(cached_addr, tmp_addr, addrlen);
187 188 189
                if (scope_id) {
                    *scope_id = if_index;
                }
S
Samuel Thibault 已提交
190
                *cached_time = curtime;
191
            }
192

B
bellard 已提交
193
            if (++found > 3) {
194
                DEBUG_MISC("  (more)");
B
bellard 已提交
195
                break;
196
            } else if (slirp_debug & DBG_MISC) {
S
Samuel Thibault 已提交
197
                char s[INET6_ADDRSTRLEN];
198
                const char *res = inet_ntop(af, tmp_addr, s, sizeof(s));
S
Samuel Thibault 已提交
199
                if (!res) {
200
                    res = "  (string conversion error)";
S
Samuel Thibault 已提交
201
                }
202
                DEBUG_MISC("  %s", res);
S
Samuel Thibault 已提交
203
            }
B
bellard 已提交
204 205
        }
    }
B
bellard 已提交
206
    fclose(f);
B
bellard 已提交
207 208 209 210 211
    if (!found)
        return -1;
    return 0;
}

S
Samuel Thibault 已提交
212 213
int get_dns_addr(struct in_addr *pdns_addr)
{
S
Samuel Thibault 已提交
214 215
    static struct stat dns_addr_stat;

S
Samuel Thibault 已提交
216 217
    if (dns_addr.s_addr != 0) {
        int ret;
S
Samuel Thibault 已提交
218 219 220 221 222 223 224
        ret = get_dns_addr_cached(pdns_addr, &dns_addr, sizeof(dns_addr),
                                  &dns_addr_stat, &dns_addr_time);
        if (ret <= 0) {
            return ret;
        }
    }
    return get_dns_addr_resolv_conf(AF_INET, pdns_addr, &dns_addr,
225
                                    sizeof(dns_addr), NULL, &dns_addr_time);
S
Samuel Thibault 已提交
226 227
}

228
int get_dns6_addr(struct in6_addr *pdns6_addr, uint32_t *scope_id)
S
Samuel Thibault 已提交
229 230 231 232 233 234 235
{
    static struct stat dns6_addr_stat;

    if (!in6_zero(&dns6_addr)) {
        int ret;
        ret = get_dns_addr_cached(pdns6_addr, &dns6_addr, sizeof(dns6_addr),
                                  &dns6_addr_stat, &dns6_addr_time);
S
Samuel Thibault 已提交
236 237 238 239
        if (ret <= 0) {
            return ret;
        }
    }
S
Samuel Thibault 已提交
240
    return get_dns_addr_resolv_conf(AF_INET6, pdns6_addr, &dns6_addr,
241 242
                                    sizeof(dns6_addr),
                                    scope_id, &dns6_addr_time);
S
Samuel Thibault 已提交
243 244
}

B
bellard 已提交
245 246
#endif

247
static void slirp_init_once(void)
B
bellard 已提交
248
{
249
    static int initialized;
250
    const char *debug;
251 252
#ifdef _WIN32
    WSADATA Data;
B
bellard 已提交
253 254
#endif

255 256 257 258 259 260 261 262 263 264 265
    if (initialized) {
        return;
    }
    initialized = 1;

#ifdef _WIN32
    WSAStartup(MAKEWORD(2,0), &Data);
    atexit(winsock_cleanup);
#endif

    loopback_addr.s_addr = htonl(INADDR_LOOPBACK);
266
    loopback_mask = htonl(IN_CLASSA_NET);
267 268 269 270 271 272 273 274 275 276 277 278

    debug = g_getenv("SLIRP_DEBUG");
    if (debug) {
        const GDebugKey keys[] = {
            { "call", DBG_CALL },
            { "misc", DBG_MISC },
            { "error", DBG_ERROR },
        };
        slirp_debug = g_parse_debug_string(debug, keys, G_N_ELEMENTS(keys));
    }


279 280
}

281 282 283
static void slirp_state_save(QEMUFile *f, void *opaque);
static int slirp_state_load(QEMUFile *f, void *opaque, int version_id);

284 285 286 287 288
static SaveVMHandlers savevm_slirp_state = {
    .save_state = slirp_state_save,
    .load_state = slirp_state_load,
};

289
Slirp *slirp_init(int restricted, bool in_enabled, struct in_addr vnetwork,
290
                  struct in_addr vnetmask, struct in_addr vhost,
291
                  bool in6_enabled,
292 293
                  struct in6_addr vprefix_addr6, uint8_t vprefix_len,
                  struct in6_addr vhost6, const char *vhostname,
294
                  const char *tftp_server_name,
295 296 297
                  const char *tftp_path, const char *bootfile,
                  struct in_addr vdhcp_start, struct in_addr vnameserver,
                  struct in6_addr vnameserver6, const char **vdnssearch,
298
                  const char *vdomainname,
299
                  const SlirpCb *callbacks,
300
                  void *opaque)
B
bellard 已提交
301
{
302
    Slirp *slirp = g_malloc0(sizeof(Slirp));
303

304
    slirp_init_once();
B
bellard 已提交
305

306
    slirp->cb = callbacks;
307
    slirp->grand = g_rand_new();
308
    slirp->restricted = restricted;
B
bellard 已提交
309

310 311 312
    slirp->in_enabled = in_enabled;
    slirp->in6_enabled = in6_enabled;

313 314
    if_init(slirp);
    ip_init(slirp);
315
    ip6_init(slirp);
B
bellard 已提交
316 317

    /* Initialise mbufs *after* setting the MTU */
318
    m_init(slirp);
B
bellard 已提交
319

320 321 322
    slirp->vnetwork_addr = vnetwork;
    slirp->vnetwork_mask = vnetmask;
    slirp->vhost_addr = vhost;
323 324 325
    slirp->vprefix_addr6 = vprefix_addr6;
    slirp->vprefix_len = vprefix_len;
    slirp->vhost_addr6 = vhost6;
326
    if (vhostname) {
327 328
        pstrcpy(slirp->client_hostname, sizeof(slirp->client_hostname),
                vhostname);
329
    }
330 331
    slirp->tftp_prefix = g_strdup(tftp_path);
    slirp->bootp_filename = g_strdup(bootfile);
332
    slirp->vdomainname = g_strdup(vdomainname);
333 334
    slirp->vdhcp_startaddr = vdhcp_start;
    slirp->vnameserver_addr = vnameserver;
335
    slirp->vnameserver_addr6 = vnameserver6;
336
    slirp->tftp_server_name = g_strdup(tftp_server_name);
337

338 339 340 341
    if (vdnssearch) {
        translate_dnssearch(slirp, vdnssearch);
    }

342 343
    slirp->opaque = opaque;

344
    register_savevm_live(NULL, "slirp", 0, 4, &savevm_slirp_state, slirp);
345

B
Blue Swirl 已提交
346
    QTAILQ_INSERT_TAIL(&slirp_instances, slirp, entry);
347

348
    return slirp;
B
bellard 已提交
349 350
}

351 352
void slirp_cleanup(Slirp *slirp)
{
M
Marc-André Lureau 已提交
353
    struct gfwd_list *e, *next;
354

M
Marc-André Lureau 已提交
355
    for (e = slirp->guestfwd_list; e; e = next) {
356 357 358 359 360
        next = e->ex_next;
        g_free(e->ex_exec);
        g_free(e);
    }

B
Blue Swirl 已提交
361
    QTAILQ_REMOVE(&slirp_instances, slirp, entry);
J
Jan Kiszka 已提交
362

A
Alex Williamson 已提交
363
    unregister_savevm(NULL, "slirp", slirp);
364

365
    ip_cleanup(slirp);
366
    ip6_cleanup(slirp);
367 368
    m_cleanup(slirp);

369 370
    g_rand_free(slirp->grand);

371
    g_free(slirp->vdnssearch);
372 373
    g_free(slirp->tftp_prefix);
    g_free(slirp->bootp_filename);
374
    g_free(slirp->vdomainname);
375
    g_free(slirp);
376 377
}

B
bellard 已提交
378 379 380
#define CONN_CANFSEND(so) (((so)->so_state & (SS_FCANTSENDMORE|SS_ISFCONNECTED)) == SS_ISFCONNECTED)
#define CONN_CANFRCV(so) (((so)->so_state & (SS_FCANTRCVMORE|SS_ISFCONNECTED)) == SS_ISFCONNECTED)

381
static void slirp_update_timeout(uint32_t *timeout)
382
{
383 384 385 386 387 388
    Slirp *slirp;
    uint32_t t;

    if (*timeout <= TIMEOUT_FAST) {
        return;
    }
389 390

    t = MIN(1000, *timeout);
391 392 393 394 395 396 397 398 399 400 401 402

    /* If we have tcp timeout with slirp, then we will fill @timeout with
     * more precise value.
     */
    QTAILQ_FOREACH(slirp, &slirp_instances, entry) {
        if (slirp->time_fasttimo) {
            *timeout = TIMEOUT_FAST;
            return;
        }
        if (slirp->do_slowtimo) {
            t = MIN(TIMEOUT_SLOW, t);
        }
403
    }
404
    *timeout = t;
405 406
}

407
void slirp_pollfds_fill(GArray *pollfds, uint32_t *timeout)
B
bellard 已提交
408
{
J
Jan Kiszka 已提交
409
    Slirp *slirp;
B
bellard 已提交
410 411
    struct socket *so, *so_next;

B
Blue Swirl 已提交
412
    if (QTAILQ_EMPTY(&slirp_instances)) {
J
Jan Kiszka 已提交
413 414 415
        return;
    }

416 417 418
    /*
     * First, TCP sockets
     */
419

420 421 422 423 424
    QTAILQ_FOREACH(slirp, &slirp_instances, entry) {
        /*
         * *_slowtimo needs calling if there are IP fragments
         * in the fragment queue, or there are TCP connections active
         */
L
Liu Ping Fan 已提交
425
        slirp->do_slowtimo = ((slirp->tcb.so_next != &slirp->tcb) ||
426 427 428 429
                (&slirp->ipq.ip_link != slirp->ipq.ip_link.next));

        for (so = slirp->tcb.so_next; so != &slirp->tcb;
                so = so_next) {
S
Stefan Hajnoczi 已提交
430 431
            int events = 0;

432 433
            so_next = so->so_next;

S
Stefan Hajnoczi 已提交
434 435
            so->pollfds_idx = -1;

436 437 438
            /*
             * See if we need a tcp_fasttimo
             */
L
Liu Ping Fan 已提交
439 440 441
            if (slirp->time_fasttimo == 0 &&
                so->so_tcpcb->t_flags & TF_DELACK) {
                slirp->time_fasttimo = curtime; /* Flag when want a fasttimo */
442
            }
443

444 445 446 447 448 449 450
            /*
             * NOFDREF can include still connecting to local-host,
             * newly socreated() sockets etc. Don't want to select these.
             */
            if (so->so_state & SS_NOFDREF || so->s == -1) {
                continue;
            }
451

452 453 454 455
            /*
             * Set for reading sockets which are accepting
             */
            if (so->so_state & SS_FACCEPTCONN) {
S
Stefan Hajnoczi 已提交
456 457 458 459 460 461
                GPollFD pfd = {
                    .fd = so->s,
                    .events = G_IO_IN | G_IO_HUP | G_IO_ERR,
                };
                so->pollfds_idx = pollfds->len;
                g_array_append_val(pollfds, pfd);
462 463 464 465 466 467 468
                continue;
            }

            /*
             * Set for writing sockets which are connecting
             */
            if (so->so_state & SS_ISFCONNECTING) {
S
Stefan Hajnoczi 已提交
469 470 471 472 473 474
                GPollFD pfd = {
                    .fd = so->s,
                    .events = G_IO_OUT | G_IO_ERR,
                };
                so->pollfds_idx = pollfds->len;
                g_array_append_val(pollfds, pfd);
475 476 477 478 479 480 481 482
                continue;
            }

            /*
             * Set for writing if we are connected, can send more, and
             * we have something to send
             */
            if (CONN_CANFSEND(so) && so->so_rcv.sb_cc) {
S
Stefan Hajnoczi 已提交
483
                events |= G_IO_OUT | G_IO_ERR;
484 485 486 487 488 489 490 491
            }

            /*
             * Set for reading (and urgent data) if we are connected, can
             * receive more, and we have room for it XXX /2 ?
             */
            if (CONN_CANFRCV(so) &&
                (so->so_snd.sb_cc < (so->so_snd.sb_datalen/2))) {
S
Stefan Hajnoczi 已提交
492 493 494 495 496 497 498 499 500 501
                events |= G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_PRI;
            }

            if (events) {
                GPollFD pfd = {
                    .fd = so->s,
                    .events = events,
                };
                so->pollfds_idx = pollfds->len;
                g_array_append_val(pollfds, pfd);
502 503 504 505 506 507 508 509 510 511
            }
        }

        /*
         * UDP sockets
         */
        for (so = slirp->udb.so_next; so != &slirp->udb;
                so = so_next) {
            so_next = so->so_next;

S
Stefan Hajnoczi 已提交
512 513
            so->pollfds_idx = -1;

514 515 516 517 518 519 520 521
            /*
             * See if it's timed out
             */
            if (so->so_expire) {
                if (so->so_expire <= curtime) {
                    udp_detach(so);
                    continue;
                } else {
L
Liu Ping Fan 已提交
522
                    slirp->do_slowtimo = true; /* Let socket expire */
523
                }
524 525 526 527 528 529 530 531 532 533 534 535 536
            }

            /*
             * When UDP packets are received from over the
             * link, they're sendto()'d straight away, so
             * no need for setting for writing
             * Limit the number of packets queued by this session
             * to 4.  Note that even though we try and limit this
             * to 4 packets, the session could have more queued
             * if the packets needed to be fragmented
             * (XXX <= 4 ?)
             */
            if ((so->so_state & SS_ISFCONNECTED) && so->so_queued <= 4) {
S
Stefan Hajnoczi 已提交
537 538 539 540 541 542
                GPollFD pfd = {
                    .fd = so->s,
                    .events = G_IO_IN | G_IO_HUP | G_IO_ERR,
                };
                so->pollfds_idx = pollfds->len;
                g_array_append_val(pollfds, pfd);
543 544
            }
        }
545

546 547 548 549 550 551 552
        /*
         * ICMP sockets
         */
        for (so = slirp->icmp.so_next; so != &slirp->icmp;
                so = so_next) {
            so_next = so->so_next;

S
Stefan Hajnoczi 已提交
553 554
            so->pollfds_idx = -1;

555 556 557 558 559 560 561 562
            /*
             * See if it's timed out
             */
            if (so->so_expire) {
                if (so->so_expire <= curtime) {
                    icmp_detach(so);
                    continue;
                } else {
L
Liu Ping Fan 已提交
563
                    slirp->do_slowtimo = true; /* Let socket expire */
564 565 566 567
                }
            }

            if (so->so_state & SS_ISFCONNECTED) {
S
Stefan Hajnoczi 已提交
568 569 570 571 572 573
                GPollFD pfd = {
                    .fd = so->s,
                    .events = G_IO_IN | G_IO_HUP | G_IO_ERR,
                };
                so->pollfds_idx = pollfds->len;
                g_array_append_val(pollfds, pfd);
574 575 576
            }
        }
    }
577
    slirp_update_timeout(timeout);
578
}
B
bellard 已提交
579

S
Stefan Hajnoczi 已提交
580
void slirp_pollfds_poll(GArray *pollfds, int select_error)
B
bellard 已提交
581
{
582
    Slirp *slirp = QTAILQ_FIRST(&slirp_instances);
B
bellard 已提交
583 584 585
    struct socket *so, *so_next;
    int ret;

586
    if (!slirp) {
J
Jan Kiszka 已提交
587 588 589
        return;
    }

590
    curtime = slirp->cb->clock_get_ns() / SCALE_MS;
591

B
Blue Swirl 已提交
592
    QTAILQ_FOREACH(slirp, &slirp_instances, entry) {
593 594 595
        /*
         * See if anything has timed out
         */
L
Liu Ping Fan 已提交
596 597
        if (slirp->time_fasttimo &&
            ((curtime - slirp->time_fasttimo) >= TIMEOUT_FAST)) {
598
            tcp_fasttimo(slirp);
L
Liu Ping Fan 已提交
599
            slirp->time_fasttimo = 0;
600
        }
L
Liu Ping Fan 已提交
601 602
        if (slirp->do_slowtimo &&
            ((curtime - slirp->last_slowtimo) >= TIMEOUT_SLOW)) {
603 604
            ip_slowtimo(slirp);
            tcp_slowtimo(slirp);
L
Liu Ping Fan 已提交
605
            slirp->last_slowtimo = curtime;
606 607 608 609 610 611 612 613 614 615 616
        }

        /*
         * Check sockets
         */
        if (!select_error) {
            /*
             * Check TCP sockets
             */
            for (so = slirp->tcb.so_next; so != &slirp->tcb;
                    so = so_next) {
S
Stefan Hajnoczi 已提交
617 618
                int revents;

619 620
                so_next = so->so_next;

S
Stefan Hajnoczi 已提交
621 622 623 624 625 626
                revents = 0;
                if (so->pollfds_idx != -1) {
                    revents = g_array_index(pollfds, GPollFD,
                                            so->pollfds_idx).revents;
                }

627 628 629 630 631 632 633
                if (so->so_state & SS_NOFDREF || so->s == -1) {
                    continue;
                }

                /*
                 * Check for URG data
                 * This will soread as well, so no need to
S
Stefan Hajnoczi 已提交
634
                 * test for G_IO_IN below if this succeeds
635
                 */
S
Stefan Hajnoczi 已提交
636
                if (revents & G_IO_PRI) {
637 638 639 640 641 642
                    ret = sorecvoob(so);
                    if (ret < 0) {
                        /* Socket error might have resulted in the socket being
                         * removed, do not try to do anything more with it. */
                        continue;
                    }
643 644 645 646
                }
                /*
                 * Check sockets for reading
                 */
S
Stefan Hajnoczi 已提交
647
                else if (revents & (G_IO_IN | G_IO_HUP | G_IO_ERR)) {
648 649 650 651 652 653 654 655 656 657 658 659 660
                    /*
                     * Check for incoming connections
                     */
                    if (so->so_state & SS_FACCEPTCONN) {
                        tcp_connect(so);
                        continue;
                    } /* else */
                    ret = soread(so);

                    /* Output it if we read something */
                    if (ret > 0) {
                        tcp_output(sototcpcb(so));
                    }
661 662 663 664 665
                    if (ret < 0) {
                        /* Socket error might have resulted in the socket being
                         * removed, do not try to do anything more with it. */
                        continue;
                    }
666 667 668 669 670
                }

                /*
                 * Check sockets for writing
                 */
S
Stefan Hajnoczi 已提交
671 672
                if (!(so->so_state & SS_NOFDREF) &&
                        (revents & (G_IO_OUT | G_IO_ERR))) {
673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690
                    /*
                     * Check for non-blocking, still-connecting sockets
                     */
                    if (so->so_state & SS_ISFCONNECTING) {
                        /* Connected */
                        so->so_state &= ~SS_ISFCONNECTING;

                        ret = send(so->s, (const void *) &ret, 0, 0);
                        if (ret < 0) {
                            /* XXXXX Must fix, zero bytes is a NOP */
                            if (errno == EAGAIN || errno == EWOULDBLOCK ||
                                errno == EINPROGRESS || errno == ENOTCONN) {
                                continue;
                            }

                            /* else failed */
                            so->so_state &= SS_PERSISTENT_MASK;
                            so->so_state |= SS_NOFDREF;
B
bellard 已提交
691
                        }
692 693 694 695 696
                        /* else so->so_state &= ~SS_ISFCONNECTING; */

                        /*
                         * Continue tcp_input
                         */
697 698
                        tcp_input((struct mbuf *)NULL, sizeof(struct ip), so,
                                  so->so_ffamily);
699 700 701
                        /* continue; */
                    } else {
                        ret = sowrite(so);
702 703 704 705 706 707
                        if (ret > 0) {
                            /* Call tcp_output in case we need to send a window
                             * update to the guest, otherwise it will be stuck
                             * until it sends a window probe. */
                            tcp_output(sototcpcb(so));
                        }
708 709 710 711 712 713 714 715 716 717 718
                    }
                }
            }

            /*
             * Now UDP sockets.
             * Incoming packets are sent straight away, they're not buffered.
             * Incoming UDP data isn't buffered either.
             */
            for (so = slirp->udb.so_next; so != &slirp->udb;
                    so = so_next) {
S
Stefan Hajnoczi 已提交
719 720
                int revents;

721 722
                so_next = so->so_next;

S
Stefan Hajnoczi 已提交
723 724 725 726 727 728 729 730
                revents = 0;
                if (so->pollfds_idx != -1) {
                    revents = g_array_index(pollfds, GPollFD,
                            so->pollfds_idx).revents;
                }

                if (so->s != -1 &&
                    (revents & (G_IO_IN | G_IO_HUP | G_IO_ERR))) {
731
                    sorecvfrom(so);
732
                }
733 734 735 736 737 738 739
            }

            /*
             * Check incoming ICMP relies.
             */
            for (so = slirp->icmp.so_next; so != &slirp->icmp;
                    so = so_next) {
S
Stefan Hajnoczi 已提交
740 741 742 743 744 745 746 747 748
                    int revents;

                    so_next = so->so_next;

                    revents = 0;
                    if (so->pollfds_idx != -1) {
                        revents = g_array_index(pollfds, GPollFD,
                                                so->pollfds_idx).revents;
                    }
749

S
Stefan Hajnoczi 已提交
750 751
                    if (so->s != -1 &&
                        (revents & (G_IO_IN | G_IO_HUP | G_IO_ERR))) {
752 753 754 755
                    icmp_receive(so);
                }
            }
        }
756

J
Jan Kiszka 已提交
757
        if_start(slirp);
J
Jan Kiszka 已提交
758
    }
B
bellard 已提交
759 760
}

761
static void arp_input(Slirp *slirp, const uint8_t *pkt, int pkt_len)
B
bellard 已提交
762
{
763
    struct slirp_arphdr *ah = (struct slirp_arphdr *)(pkt + ETH_HLEN);
764
    uint8_t arp_reply[MAX(ETH_HLEN + sizeof(struct slirp_arphdr), 64)];
B
bellard 已提交
765
    struct ethhdr *reh = (struct ethhdr *)arp_reply;
766
    struct slirp_arphdr *rah = (struct slirp_arphdr *)(arp_reply + ETH_HLEN);
B
bellard 已提交
767
    int ar_op;
M
Marc-André Lureau 已提交
768
    struct gfwd_list *ex_ptr;
B
bellard 已提交
769

770 771 772 773
    if (!slirp->in_enabled) {
        return;
    }

B
bellard 已提交
774 775 776
    ar_op = ntohs(ah->ar_op);
    switch(ar_op) {
    case ARPOP_REQUEST:
F
Fabien Chouteau 已提交
777 778 779 780 781 782
        if (ah->ar_tip == ah->ar_sip) {
            /* Gratuitous ARP */
            arp_table_add(slirp, ah->ar_sip, ah->ar_sha);
            return;
        }

783 784 785 786
        if ((ah->ar_tip & slirp->vnetwork_mask.s_addr) ==
            slirp->vnetwork_addr.s_addr) {
            if (ah->ar_tip == slirp->vnameserver_addr.s_addr ||
                ah->ar_tip == slirp->vhost_addr.s_addr)
B
bellard 已提交
787
                goto arp_ok;
M
Marc-André Lureau 已提交
788
            for (ex_ptr = slirp->guestfwd_list; ex_ptr; ex_ptr = ex_ptr->ex_next) {
789
                if (ex_ptr->ex_addr.s_addr == ah->ar_tip)
B
bellard 已提交
790 791 792 793
                    goto arp_ok;
            }
            return;
        arp_ok:
794
            memset(arp_reply, 0, sizeof(arp_reply));
F
Fabien Chouteau 已提交
795 796

            arp_table_add(slirp, ah->ar_sip, ah->ar_sha);
B
bellard 已提交
797 798 799

            /* ARP request for alias/dns mac address */
            memcpy(reh->h_dest, pkt + ETH_ALEN, ETH_ALEN);
800 801
            memcpy(reh->h_source, special_ethaddr, ETH_ALEN - 4);
            memcpy(&reh->h_source[2], &ah->ar_tip, 4);
B
bellard 已提交
802 803 804 805 806 807 808 809
            reh->h_proto = htons(ETH_P_ARP);

            rah->ar_hrd = htons(1);
            rah->ar_pro = htons(ETH_P_IP);
            rah->ar_hln = ETH_ALEN;
            rah->ar_pln = 4;
            rah->ar_op = htons(ARPOP_REPLY);
            memcpy(rah->ar_sha, reh->h_source, ETH_ALEN);
810
            rah->ar_sip = ah->ar_tip;
B
bellard 已提交
811
            memcpy(rah->ar_tha, ah->ar_sha, ETH_ALEN);
812
            rah->ar_tip = ah->ar_sip;
813
            slirp->cb->output(slirp->opaque, arp_reply, sizeof(arp_reply));
B
bellard 已提交
814 815
        }
        break;
816
    case ARPOP_REPLY:
F
Fabien Chouteau 已提交
817
        arp_table_add(slirp, ah->ar_sip, ah->ar_sha);
818
        break;
B
bellard 已提交
819 820 821 822 823
    default:
        break;
    }
}

824
void slirp_input(Slirp *slirp, const uint8_t *pkt, int pkt_len)
B
bellard 已提交
825 826 827 828 829 830
{
    struct mbuf *m;
    int proto;

    if (pkt_len < ETH_HLEN)
        return;
831

832
    proto = (((uint16_t) pkt[12]) << 8) + pkt[13];
B
bellard 已提交
833 834
    switch(proto) {
    case ETH_P_ARP:
835
        arp_input(slirp, pkt, pkt_len);
B
bellard 已提交
836 837
        break;
    case ETH_P_IP:
838
    case ETH_P_IPV6:
839
        m = m_get(slirp);
B
bellard 已提交
840 841
        if (!m)
            return;
842 843 844 845
        /* Note: we add 2 to align the IP header on 4 bytes,
         * and add the margin for the tcpiphdr overhead  */
        if (M_FREEROOM(m) < pkt_len + TCPIPHDR_DELTA + 2) {
            m_inc(m, pkt_len + TCPIPHDR_DELTA + 2);
A
aurel32 已提交
846
        }
847 848
        m->m_len = pkt_len + TCPIPHDR_DELTA + 2;
        memcpy(m->m_data + TCPIPHDR_DELTA + 2, pkt, pkt_len);
B
bellard 已提交
849

850 851
        m->m_data += TCPIPHDR_DELTA + 2 + ETH_HLEN;
        m->m_len -= TCPIPHDR_DELTA + 2 + ETH_HLEN;
B
bellard 已提交
852

853 854 855 856 857
        if (proto == ETH_P_IP) {
            ip_input(m);
        } else if (proto == ETH_P_IPV6) {
            ip6_input(m);
        }
B
bellard 已提交
858
        break;
859

860 861 862 863
    case ETH_P_NCSI:
        ncsi_input(slirp, pkt, pkt_len);
        break;

B
bellard 已提交
864 865 866 867 868
    default:
        break;
    }
}

869 870 871
/* Prepare the IPv4 packet to be sent to the ethernet device. Returns 1 if no
 * packet should be sent, 0 if the packet must be re-queued, 2 if the packet
 * is ready to go.
F
Fabien Chouteau 已提交
872
 */
873 874
static int if_encap4(Slirp *slirp, struct mbuf *ifm, struct ethhdr *eh,
        uint8_t ethaddr[ETH_ALEN])
B
bellard 已提交
875
{
F
Fabien Chouteau 已提交
876
    const struct ip *iph = (const struct ip *)ifm->m_data;
B
bellard 已提交
877

878 879 880 881 882
    if (iph->ip_dst.s_addr == 0) {
        /* 0.0.0.0 can not be a destination address, something went wrong,
         * avoid making it worse */
        return 1;
    }
F
Fabien Chouteau 已提交
883
    if (!arp_table_search(slirp, iph->ip_dst.s_addr, ethaddr)) {
884
        uint8_t arp_req[ETH_HLEN + sizeof(struct slirp_arphdr)];
885
        struct ethhdr *reh = (struct ethhdr *)arp_req;
886
        struct slirp_arphdr *rah = (struct slirp_arphdr *)(arp_req + ETH_HLEN);
887

888
        if (!ifm->resolution_requested) {
F
Fabien Chouteau 已提交
889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912
            /* If the client addr is not known, send an ARP request */
            memset(reh->h_dest, 0xff, ETH_ALEN);
            memcpy(reh->h_source, special_ethaddr, ETH_ALEN - 4);
            memcpy(&reh->h_source[2], &slirp->vhost_addr, 4);
            reh->h_proto = htons(ETH_P_ARP);
            rah->ar_hrd = htons(1);
            rah->ar_pro = htons(ETH_P_IP);
            rah->ar_hln = ETH_ALEN;
            rah->ar_pln = 4;
            rah->ar_op = htons(ARPOP_REQUEST);

            /* source hw addr */
            memcpy(rah->ar_sha, special_ethaddr, ETH_ALEN - 4);
            memcpy(&rah->ar_sha[2], &slirp->vhost_addr, 4);

            /* source IP */
            rah->ar_sip = slirp->vhost_addr.s_addr;

            /* target hw addr (none) */
            memset(rah->ar_tha, 0, ETH_ALEN);

            /* target IP */
            rah->ar_tip = iph->ip_dst.s_addr;
            slirp->client_ipaddr = iph->ip_dst;
913
            slirp->cb->output(slirp->opaque, arp_req, sizeof(arp_req));
914
            ifm->resolution_requested = true;
915 916

            /* Expire request and drop outgoing packet after 1 second */
917
            ifm->expiration_date = slirp->cb->clock_get_ns() + 1000000000ULL;
F
Fabien Chouteau 已提交
918 919
        }
        return 0;
920
    } else {
921
        memcpy(eh->h_source, special_ethaddr, ETH_ALEN - 4);
922
        /* XXX: not correct */
923
        memcpy(&eh->h_source[2], &slirp->vhost_addr, 4);
924
        eh->h_proto = htons(ETH_P_IP);
925 926 927 928 929 930

        /* Send this */
        return 2;
    }
}

931 932 933 934 935 936 937 938 939 940 941 942
/* Prepare the IPv6 packet to be sent to the ethernet device. Returns 1 if no
 * packet should be sent, 0 if the packet must be re-queued, 2 if the packet
 * is ready to go.
 */
static int if_encap6(Slirp *slirp, struct mbuf *ifm, struct ethhdr *eh,
        uint8_t ethaddr[ETH_ALEN])
{
    const struct ip6 *ip6h = mtod(ifm, const struct ip6 *);
    if (!ndp_table_search(slirp, ip6h->ip_dst, ethaddr)) {
        if (!ifm->resolution_requested) {
            ndp_send_ns(slirp, ip6h->ip_dst);
            ifm->resolution_requested = true;
943
            ifm->expiration_date = slirp->cb->clock_get_ns() + 1000000000ULL;
944 945 946 947 948 949 950 951 952 953 954
        }
        return 0;
    } else {
        eh->h_proto = htons(ETH_P_IPV6);
        in6_compute_ethaddr(ip6h->ip_src, eh->h_source);

        /* Send this */
        return 2;
    }
}

955 956 957 958 959 960 961 962 963 964 965 966
/* Output the IP packet to the ethernet device. Returns 0 if the packet must be
 * re-queued.
 */
int if_encap(Slirp *slirp, struct mbuf *ifm)
{
    uint8_t buf[1600];
    struct ethhdr *eh = (struct ethhdr *)buf;
    uint8_t ethaddr[ETH_ALEN];
    const struct ip *iph = (const struct ip *)ifm->m_data;
    int ret;

    if (ifm->m_len + ETH_HLEN > sizeof(buf)) {
F
Fabien Chouteau 已提交
967
        return 1;
968
    }
969 970 971 972 973 974 975 976 977

    switch (iph->ip_v) {
    case IPVERSION:
        ret = if_encap4(slirp, ifm, eh, ethaddr);
        if (ret < 2) {
            return ret;
        }
        break;

978 979 980 981 982 983 984
    case IP6VERSION:
        ret = if_encap6(slirp, ifm, eh, ethaddr);
        if (ret < 2) {
            return ret;
        }
        break;

985
    default:
986
        g_assert_not_reached();
987 988 989 990
        break;
    }

    memcpy(eh->h_dest, ethaddr, ETH_ALEN);
991 992 993 994 995 996
    DEBUG_ARG("src = %02x:%02x:%02x:%02x:%02x:%02x",
              eh->h_source[0], eh->h_source[1], eh->h_source[2],
              eh->h_source[3], eh->h_source[4], eh->h_source[5]);
    DEBUG_ARG("dst = %02x:%02x:%02x:%02x:%02x:%02x",
              eh->h_dest[0], eh->h_dest[1], eh->h_dest[2],
              eh->h_dest[3], eh->h_dest[4], eh->h_dest[5]);
997
    memcpy(buf + sizeof(struct ethhdr), ifm->m_data, ifm->m_len);
998
    slirp->cb->output(slirp->opaque, buf, ifm->m_len + ETH_HLEN);
999
    return 1;
B
bellard 已提交
1000
}
B
bellard 已提交
1001

1002
/* Drop host forwarding rule, return 0 if found. */
1003 1004
int slirp_remove_hostfwd(Slirp *slirp, int is_udp, struct in_addr host_addr,
                         int host_port)
1005 1006
{
    struct socket *so;
1007
    struct socket *head = (is_udp ? &slirp->udb : &slirp->tcb);
1008 1009 1010
    struct sockaddr_in addr;
    int port = htons(host_port);
    socklen_t addr_len;
1011 1012

    for (so = head->so_next; so != head; so = so->so_next) {
1013
        addr_len = sizeof(addr);
1014 1015
        if ((so->so_state & SS_HOSTFWD) &&
            getsockname(so->s, (struct sockaddr *)&addr, &addr_len) == 0 &&
1016
            addr.sin_addr.s_addr == host_addr.s_addr &&
1017
            addr.sin_port == port) {
1018 1019
            close(so->s);
            sofree(so);
1020
            return 0;
1021 1022 1023
        }
    }

1024
    return -1;
1025 1026
}

1027 1028
int slirp_add_hostfwd(Slirp *slirp, int is_udp, struct in_addr host_addr,
                      int host_port, struct in_addr guest_addr, int guest_port)
B
bellard 已提交
1029
{
1030
    if (!guest_addr.s_addr) {
1031
        guest_addr = slirp->vdhcp_startaddr;
1032
    }
B
bellard 已提交
1033
    if (is_udp) {
1034 1035
        if (!udp_listen(slirp, host_addr.s_addr, htons(host_port),
                        guest_addr.s_addr, htons(guest_port), SS_HOSTFWD))
B
bellard 已提交
1036 1037
            return -1;
    } else {
1038 1039
        if (!tcp_listen(slirp, host_addr.s_addr, htons(host_port),
                        guest_addr.s_addr, htons(guest_port), SS_HOSTFWD))
B
bellard 已提交
1040 1041 1042 1043
            return -1;
    }
    return 0;
}
B
bellard 已提交
1044

1045 1046
static bool
check_guestfwd(Slirp *slirp, struct in_addr *guest_addr, int guest_port)
B
bellard 已提交
1047
{
1048 1049
    struct gfwd_list *tmp_ptr;

1050 1051
    if (!guest_addr->s_addr) {
        guest_addr->s_addr = slirp->vnetwork_addr.s_addr |
1052
            (htonl(0x0204) & ~slirp->vnetwork_mask.s_addr);
1053
    }
1054
    if ((guest_addr->s_addr & slirp->vnetwork_mask.s_addr) !=
1055
        slirp->vnetwork_addr.s_addr ||
1056 1057
        guest_addr->s_addr == slirp->vhost_addr.s_addr ||
        guest_addr->s_addr == slirp->vnameserver_addr.s_addr) {
1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074
        return false;
    }

    /* check if the port is "bound" */
    for (tmp_ptr = slirp->guestfwd_list; tmp_ptr; tmp_ptr = tmp_ptr->ex_next) {
        if (guest_port == tmp_ptr->ex_fport &&
            guest_addr->s_addr == tmp_ptr->ex_addr.s_addr)
            return false;
    }

    return true;
}

int slirp_add_exec(Slirp *slirp, void *chardev, const char *cmdline,
                   struct in_addr *guest_addr, int guest_port)
{
    if (!check_guestfwd(slirp, guest_addr, guest_port)) {
1075 1076
        return -1;
    }
1077

M
Marc-André Lureau 已提交
1078
    return add_exec(&slirp->guestfwd_list, chardev, cmdline, *guest_addr,
1079
                    htons(guest_port));
B
bellard 已提交
1080
}
1081 1082 1083

ssize_t slirp_send(struct socket *so, const void *buf, size_t len, int flags)
{
1084
    if (so->s == -1 && so->chardev) {
1085 1086
        /* XXX this blocks entire thread. Rewrite to use
         * qemu_chr_fe_write and background I/O callbacks */
1087
        qemu_chr_fe_write_all(so->chardev, buf, len);
1088 1089
        return len;
    }
1090

1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101
    if (so->s == -1) {
        /*
         * This should in theory not happen but it is hard to be
         * sure because some code paths will end up with so->s == -1
         * on a failure but don't dispose of the struct socket.
         * Check specifically, so we don't pass -1 to send().
         */
        errno = EBADF;
        return -1;
    }

1102
    return send(so->s, buf, len, flags);
1103 1104
}

1105
static struct socket *
1106
slirp_find_ctl_socket(Slirp *slirp, struct in_addr guest_addr, int guest_port)
1107
{
1108
    struct socket *so;
1109

1110
    for (so = slirp->tcb.so_next; so != &slirp->tcb; so = so->so_next) {
1111 1112 1113 1114 1115 1116
        if (so->so_faddr.s_addr == guest_addr.s_addr &&
            htons(so->so_fport) == guest_port) {
            return so;
        }
    }
    return NULL;
1117 1118
}

1119 1120
size_t slirp_socket_can_recv(Slirp *slirp, struct in_addr guest_addr,
                             int guest_port)
1121
{
1122 1123
    struct iovec iov[2];
    struct socket *so;
1124

1125
    so = slirp_find_ctl_socket(slirp, guest_addr, guest_port);
1126

1127 1128 1129
    if (!so || so->so_state & SS_NOFDREF) {
        return 0;
    }
1130

1131 1132 1133
    if (!CONN_CANFRCV(so) || so->so_snd.sb_cc >= (so->so_snd.sb_datalen/2)) {
        return 0;
    }
1134

1135
    return sopreprbuf(so, iov, NULL);
1136 1137
}

1138
void slirp_socket_recv(Slirp *slirp, struct in_addr guest_addr, int guest_port,
1139
                       const uint8_t *buf, int size)
1140 1141
{
    int ret;
1142
    struct socket *so = slirp_find_ctl_socket(slirp, guest_addr, guest_port);
1143

1144 1145 1146
    if (!so)
        return;

B
blueswir1 已提交
1147
    ret = soreadbuf(so, (const char *)buf, size);
1148 1149 1150 1151

    if (ret > 0)
        tcp_output(sototcpcb(so));
}
1152

1153
static int slirp_tcp_post_load(void *opaque, int version)
1154
{
1155
    tcp_template((struct tcpcb *)opaque);
1156

1157
    return 0;
1158 1159
}

1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208
static const VMStateDescription vmstate_slirp_tcp = {
    .name = "slirp-tcp",
    .version_id = 0,
    .post_load = slirp_tcp_post_load,
    .fields = (VMStateField[]) {
        VMSTATE_INT16(t_state, struct tcpcb),
        VMSTATE_INT16_ARRAY(t_timer, struct tcpcb, TCPT_NTIMERS),
        VMSTATE_INT16(t_rxtshift, struct tcpcb),
        VMSTATE_INT16(t_rxtcur, struct tcpcb),
        VMSTATE_INT16(t_dupacks, struct tcpcb),
        VMSTATE_UINT16(t_maxseg, struct tcpcb),
        VMSTATE_UINT8(t_force, struct tcpcb),
        VMSTATE_UINT16(t_flags, struct tcpcb),
        VMSTATE_UINT32(snd_una, struct tcpcb),
        VMSTATE_UINT32(snd_nxt, struct tcpcb),
        VMSTATE_UINT32(snd_up, struct tcpcb),
        VMSTATE_UINT32(snd_wl1, struct tcpcb),
        VMSTATE_UINT32(snd_wl2, struct tcpcb),
        VMSTATE_UINT32(iss, struct tcpcb),
        VMSTATE_UINT32(snd_wnd, struct tcpcb),
        VMSTATE_UINT32(rcv_wnd, struct tcpcb),
        VMSTATE_UINT32(rcv_nxt, struct tcpcb),
        VMSTATE_UINT32(rcv_up, struct tcpcb),
        VMSTATE_UINT32(irs, struct tcpcb),
        VMSTATE_UINT32(rcv_adv, struct tcpcb),
        VMSTATE_UINT32(snd_max, struct tcpcb),
        VMSTATE_UINT32(snd_cwnd, struct tcpcb),
        VMSTATE_UINT32(snd_ssthresh, struct tcpcb),
        VMSTATE_INT16(t_idle, struct tcpcb),
        VMSTATE_INT16(t_rtt, struct tcpcb),
        VMSTATE_UINT32(t_rtseq, struct tcpcb),
        VMSTATE_INT16(t_srtt, struct tcpcb),
        VMSTATE_INT16(t_rttvar, struct tcpcb),
        VMSTATE_UINT16(t_rttmin, struct tcpcb),
        VMSTATE_UINT32(max_sndwnd, struct tcpcb),
        VMSTATE_UINT8(t_oobflags, struct tcpcb),
        VMSTATE_UINT8(t_iobc, struct tcpcb),
        VMSTATE_INT16(t_softerror, struct tcpcb),
        VMSTATE_UINT8(snd_scale, struct tcpcb),
        VMSTATE_UINT8(rcv_scale, struct tcpcb),
        VMSTATE_UINT8(request_r_scale, struct tcpcb),
        VMSTATE_UINT8(requested_s_scale, struct tcpcb),
        VMSTATE_UINT32(ts_recent, struct tcpcb),
        VMSTATE_UINT32(ts_recent_age, struct tcpcb),
        VMSTATE_UINT32(last_ack_sent, struct tcpcb),
        VMSTATE_END_OF_LIST()
    }
};

D
Dr. David Alan Gilbert 已提交
1209 1210 1211 1212 1213 1214 1215 1216 1217
/* The sbuf has a pair of pointers that are migrated as offsets;
 * we calculate the offsets and restore the pointers using
 * pre_save/post_load on a tmp structure.
 */
struct sbuf_tmp {
    struct sbuf *parent;
    uint32_t roff, woff;
};

1218
static int sbuf_tmp_pre_save(void *opaque)
D
Dr. David Alan Gilbert 已提交
1219 1220 1221 1222
{
    struct sbuf_tmp *tmp = opaque;
    tmp->woff = tmp->parent->sb_wptr - tmp->parent->sb_data;
    tmp->roff = tmp->parent->sb_rptr - tmp->parent->sb_data;
1223 1224

    return 0;
D
Dr. David Alan Gilbert 已提交
1225 1226 1227
}

static int sbuf_tmp_post_load(void *opaque, int version)
1228
{
D
Dr. David Alan Gilbert 已提交
1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239
    struct sbuf_tmp *tmp = opaque;
    uint32_t requested_len = tmp->parent->sb_datalen;

    /* Allocate the buffer space used by the field after the tmp */
    sbreserve(tmp->parent, tmp->parent->sb_datalen);

    if (tmp->parent->sb_datalen != requested_len) {
        return -ENOMEM;
    }
    if (tmp->woff >= requested_len ||
        tmp->roff >= requested_len) {
1240 1241
        g_critical("invalid sbuf offsets r/w=%u/%u len=%u",
                   tmp->roff, tmp->woff, requested_len);
D
Dr. David Alan Gilbert 已提交
1242 1243 1244 1245 1246 1247 1248
        return -EINVAL;
    }

    tmp->parent->sb_wptr = tmp->parent->sb_data + tmp->woff;
    tmp->parent->sb_rptr = tmp->parent->sb_data + tmp->roff;

    return 0;
1249 1250
}

D
Dr. David Alan Gilbert 已提交
1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275

static const VMStateDescription vmstate_slirp_sbuf_tmp = {
    .name = "slirp-sbuf-tmp",
    .post_load = sbuf_tmp_post_load,
    .pre_save  = sbuf_tmp_pre_save,
    .version_id = 0,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(woff, struct sbuf_tmp),
        VMSTATE_UINT32(roff, struct sbuf_tmp),
        VMSTATE_END_OF_LIST()
    }
};

static const VMStateDescription vmstate_slirp_sbuf = {
    .name = "slirp-sbuf",
    .version_id = 0,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(sb_cc, struct sbuf),
        VMSTATE_UINT32(sb_datalen, struct sbuf),
        VMSTATE_WITH_TMP(struct sbuf, struct sbuf_tmp, vmstate_slirp_sbuf_tmp),
        VMSTATE_VBUFFER_UINT32(sb_data, struct sbuf, 0, NULL, sb_datalen),
        VMSTATE_END_OF_LIST()
    }
};

1276 1277 1278 1279
static bool slirp_older_than_v4(void *opaque, int version_id)
{
    return version_id < 4;
}
D
Dr. David Alan Gilbert 已提交
1280

1281
static bool slirp_family_inet(void *opaque, int version_id)
1282
{
1283 1284 1285 1286 1287 1288 1289 1290 1291
    union slirp_sockaddr *ssa = (union slirp_sockaddr *)opaque;
    return ssa->ss.ss_family == AF_INET;
}

static int slirp_socket_pre_load(void *opaque)
{
    struct socket *so = opaque;
    if (tcp_attach(so) < 0) {
        return -ENOMEM;
1292
    }
1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
    /* Older versions don't load these fields */
    so->so_ffamily = AF_INET;
    so->so_lfamily = AF_INET;
    return 0;
}

#ifndef _WIN32
#define VMSTATE_SIN4_ADDR(f, s, t) VMSTATE_UINT32_TEST(f, s, t)
#else
/* Win uses u_long rather than uint32_t - but it's still 32bits long */
#define VMSTATE_SIN4_ADDR(f, s, t) VMSTATE_SINGLE_TEST(f, s, t, 0, \
                                       vmstate_info_uint32, u_long)
#endif

/* The OS provided ss_family field isn't that portable; it's size
 * and type varies (16/8 bit, signed, unsigned)
 * and the values it contains aren't fully portable.
 */
typedef struct SS_FamilyTmpStruct {
    union slirp_sockaddr    *parent;
    uint16_t                 portable_family;
} SS_FamilyTmpStruct;

#define SS_FAMILY_MIG_IPV4   2  /* Linux, BSD, Win... */
#define SS_FAMILY_MIG_IPV6  10  /* Linux */
#define SS_FAMILY_MIG_OTHER 0xffff

1320
static int ss_family_pre_save(void *opaque)
1321 1322 1323 1324 1325 1326 1327 1328 1329 1330
{
    SS_FamilyTmpStruct *tss = opaque;

    tss->portable_family = SS_FAMILY_MIG_OTHER;

    if (tss->parent->ss.ss_family == AF_INET) {
        tss->portable_family = SS_FAMILY_MIG_IPV4;
    } else if (tss->parent->ss.ss_family == AF_INET6) {
        tss->portable_family = SS_FAMILY_MIG_IPV6;
    }
1331 1332

    return 0;
1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346
}

static int ss_family_post_load(void *opaque, int version_id)
{
    SS_FamilyTmpStruct *tss = opaque;

    switch (tss->portable_family) {
    case SS_FAMILY_MIG_IPV4:
        tss->parent->ss.ss_family = AF_INET;
        break;
    case SS_FAMILY_MIG_IPV6:
    case 23: /* compatibility: AF_INET6 from mingw */
    case 28: /* compatibility: AF_INET6 from FreeBSD sys/socket.h */
        tss->parent->ss.ss_family = AF_INET6;
1347 1348
        break;
    default:
1349
        g_critical("invalid ss_family type %x", tss->portable_family);
1350
        return -EINVAL;
1351
    }
1352 1353

    return 0;
1354 1355
}

1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425
static const VMStateDescription vmstate_slirp_ss_family = {
    .name = "slirp-socket-addr/ss_family",
    .pre_save  = ss_family_pre_save,
    .post_load = ss_family_post_load,
    .fields = (VMStateField[]) {
        VMSTATE_UINT16(portable_family, SS_FamilyTmpStruct),
        VMSTATE_END_OF_LIST()
    }
};

static const VMStateDescription vmstate_slirp_socket_addr = {
    .name = "slirp-socket-addr",
    .version_id = 4,
    .fields = (VMStateField[]) {
        VMSTATE_WITH_TMP(union slirp_sockaddr, SS_FamilyTmpStruct,
                            vmstate_slirp_ss_family),
        VMSTATE_SIN4_ADDR(sin.sin_addr.s_addr, union slirp_sockaddr,
                            slirp_family_inet),
        VMSTATE_UINT16_TEST(sin.sin_port, union slirp_sockaddr,
                            slirp_family_inet),

#if 0
        /* Untested: Needs checking by someone with IPv6 test */
        VMSTATE_BUFFER_TEST(sin6.sin6_addr, union slirp_sockaddr,
                            slirp_family_inet6),
        VMSTATE_UINT16_TEST(sin6.sin6_port, union slirp_sockaddr,
                            slirp_family_inet6),
        VMSTATE_UINT32_TEST(sin6.sin6_flowinfo, union slirp_sockaddr,
                            slirp_family_inet6),
        VMSTATE_UINT32_TEST(sin6.sin6_scope_id, union slirp_sockaddr,
                            slirp_family_inet6),
#endif

        VMSTATE_END_OF_LIST()
    }
};

static const VMStateDescription vmstate_slirp_socket = {
    .name = "slirp-socket",
    .version_id = 4,
    .pre_load = slirp_socket_pre_load,
    .fields = (VMStateField[]) {
        VMSTATE_UINT32(so_urgc, struct socket),
        /* Pre-v4 versions */
        VMSTATE_SIN4_ADDR(so_faddr.s_addr, struct socket,
                            slirp_older_than_v4),
        VMSTATE_SIN4_ADDR(so_laddr.s_addr, struct socket,
                            slirp_older_than_v4),
        VMSTATE_UINT16_TEST(so_fport, struct socket, slirp_older_than_v4),
        VMSTATE_UINT16_TEST(so_lport, struct socket, slirp_older_than_v4),
        /* v4 and newer */
        VMSTATE_STRUCT(fhost, struct socket, 4, vmstate_slirp_socket_addr,
                       union slirp_sockaddr),
        VMSTATE_STRUCT(lhost, struct socket, 4, vmstate_slirp_socket_addr,
                       union slirp_sockaddr),

        VMSTATE_UINT8(so_iptos, struct socket),
        VMSTATE_UINT8(so_emu, struct socket),
        VMSTATE_UINT8(so_type, struct socket),
        VMSTATE_INT32(so_state, struct socket),
        VMSTATE_STRUCT(so_rcv, struct socket, 0, vmstate_slirp_sbuf,
                       struct sbuf),
        VMSTATE_STRUCT(so_snd, struct socket, 0, vmstate_slirp_sbuf,
                       struct sbuf),
        VMSTATE_STRUCT_POINTER(so_tcpcb, struct socket, vmstate_slirp_tcp,
                       struct tcpcb),
        VMSTATE_END_OF_LIST()
    }
};

1426 1427 1428 1429 1430 1431 1432 1433
static const VMStateDescription vmstate_slirp_bootp_client = {
    .name = "slirp_bootpclient",
    .fields = (VMStateField[]) {
        VMSTATE_UINT16(allocated, BOOTPClient),
        VMSTATE_BUFFER(macaddr, BOOTPClient),
        VMSTATE_END_OF_LIST()
    }
};
1434

1435 1436 1437 1438 1439 1440 1441 1442
static const VMStateDescription vmstate_slirp = {
    .name = "slirp",
    .version_id = 4,
    .fields = (VMStateField[]) {
        VMSTATE_UINT16_V(ip_id, Slirp, 2),
        VMSTATE_STRUCT_ARRAY(bootp_clients, Slirp, NB_BOOTP_CLIENTS, 3,
                             vmstate_slirp_bootp_client, BOOTPClient),
        VMSTATE_END_OF_LIST()
1443
    }
1444
};
1445

1446 1447
static void slirp_state_save(QEMUFile *f, void *opaque)
{
1448
    Slirp *slirp = opaque;
M
Marc-André Lureau 已提交
1449
    struct gfwd_list *ex_ptr;
1450

M
Marc-André Lureau 已提交
1451
    for (ex_ptr = slirp->guestfwd_list; ex_ptr; ex_ptr = ex_ptr->ex_next)
1452
        if (ex_ptr->ex_chardev) {
1453
            struct socket *so;
1454 1455
            so = slirp_find_ctl_socket(slirp, ex_ptr->ex_addr,
                                       ntohs(ex_ptr->ex_fport));
1456 1457 1458 1459
            if (!so)
                continue;

            qemu_put_byte(f, 42);
1460
            vmstate_save_state(f, &vmstate_slirp_socket, so, NULL);
1461 1462
        }
    qemu_put_byte(f, 0);
J
Jan Kiszka 已提交
1463

1464
    vmstate_save_state(f, &vmstate_slirp, slirp, NULL);
1465 1466 1467 1468 1469
}


static int slirp_state_load(QEMUFile *f, void *opaque, int version_id)
{
1470
    Slirp *slirp = opaque;
M
Marc-André Lureau 已提交
1471
    struct gfwd_list *ex_ptr;
1472

1473
    while (qemu_get_byte(f)) {
1474
        int ret;
1475
        struct socket *so = socreate(slirp);
1476

1477
        ret = vmstate_load_state(f, &vmstate_slirp_socket, so, version_id);
1478 1479 1480 1481

        if (ret < 0)
            return ret;

1482 1483
        if ((so->so_faddr.s_addr & slirp->vnetwork_mask.s_addr) !=
            slirp->vnetwork_addr.s_addr) {
1484
            return -EINVAL;
1485
        }
M
Marc-André Lureau 已提交
1486
        for (ex_ptr = slirp->guestfwd_list; ex_ptr; ex_ptr = ex_ptr->ex_next) {
1487
            if (ex_ptr->ex_chardev &&
1488 1489
                so->so_faddr.s_addr == ex_ptr->ex_addr.s_addr &&
                so->so_fport == ex_ptr->ex_fport) {
1490
                break;
1491 1492
            }
        }
1493 1494 1495 1496
        if (!ex_ptr)
            return -EINVAL;
    }

1497
    return vmstate_load_state(f, &vmstate_slirp, slirp, version_id);
1498
}