| File: | slirp/slirp.c |
| Location: | line 777, column 13 |
| Description: | The left operand of '==' is a garbage value |
| 1 | /* | ||
| 2 | * libslirp glue | ||
| 3 | * | ||
| 4 | * Copyright (c) 2004-2008 Fabrice Bellard | ||
| 5 | * | ||
| 6 | * Permission is hereby granted, free of charge, to any person obtaining a copy | ||
| 7 | * of this software and associated documentation files (the "Software"), to deal | ||
| 8 | * in the Software without restriction, including without limitation the rights | ||
| 9 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | ||
| 10 | * copies of the Software, and to permit persons to whom the Software is | ||
| 11 | * furnished to do so, subject to the following conditions: | ||
| 12 | * | ||
| 13 | * The above copyright notice and this permission notice shall be included in | ||
| 14 | * all copies or substantial portions of the Software. | ||
| 15 | * | ||
| 16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | ||
| 17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | ||
| 18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | ||
| 19 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | ||
| 20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | ||
| 21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | ||
| 22 | * THE SOFTWARE. | ||
| 23 | */ | ||
| 24 | #include "qemu-common.h" | ||
| 25 | #include "qemu-timer.h" | ||
| 26 | #include "qemu-char.h" | ||
| 27 | #include "slirp.h" | ||
| 28 | #include "hw/hw.h" | ||
| 29 | |||
| 30 | /* host loopback address */ | ||
| 31 | struct in_addr loopback_addr; | ||
| 32 | |||
| 33 | /* emulated hosts use the MAC addr 52:55:IP:IP:IP:IP */ | ||
| 34 | static const uint8_t special_ethaddr[ETH_ALEN6] = { | ||
| 35 | 0x52, 0x55, 0x00, 0x00, 0x00, 0x00 | ||
| 36 | }; | ||
| 37 | |||
| 38 | static const uint8_t zero_ethaddr[ETH_ALEN6] = { 0, 0, 0, 0, 0, 0 }; | ||
| 39 | |||
| 40 | /* XXX: suppress those select globals */ | ||
| 41 | fd_set *global_readfds, *global_writefds, *global_xfds; | ||
| 42 | |||
| 43 | u_int curtime; | ||
| 44 | static u_int time_fasttimo, last_slowtimo; | ||
| 45 | static int do_slowtimo; | ||
| 46 | |||
| 47 | static QTAILQ_HEAD(slirp_instances, Slirp)struct slirp_instances { struct Slirp *tqh_first; struct Slirp * *tqh_last; } slirp_instances = | ||
| 48 | QTAILQ_HEAD_INITIALIZER(slirp_instances){ ((void*)0), &(slirp_instances).tqh_first }; | ||
| 49 | |||
| 50 | static struct in_addr dns_addr; | ||
| 51 | static u_int dns_addr_time; | ||
| 52 | |||
| 53 | #ifdef _WIN32 | ||
| 54 | |||
| 55 | int get_dns_addr(struct in_addr *pdns_addr) | ||
| 56 | { | ||
| 57 | FIXED_INFO *FixedInfo=NULL((void*)0); | ||
| 58 | ULONG BufLen; | ||
| 59 | DWORD ret; | ||
| 60 | IP_ADDR_STRING *pIPAddr; | ||
| 61 | struct in_addr tmp_addr; | ||
| 62 | |||
| 63 | if (dns_addr.s_addr != 0 && (curtime - dns_addr_time) < 1000) { | ||
| 64 | *pdns_addr = dns_addr; | ||
| 65 | return 0; | ||
| 66 | } | ||
| 67 | |||
| 68 | FixedInfo = (FIXED_INFO *)GlobalAlloc(GPTR, sizeof(FIXED_INFO)); | ||
| 69 | BufLen = sizeof(FIXED_INFO); | ||
| 70 | |||
| 71 | if (ERROR_BUFFER_OVERFLOW == GetNetworkParams(FixedInfo, &BufLen)) { | ||
| 72 | if (FixedInfo) { | ||
| 73 | GlobalFree(FixedInfo); | ||
| 74 | FixedInfo = NULL((void*)0); | ||
| 75 | } | ||
| 76 | FixedInfo = GlobalAlloc(GPTR, BufLen); | ||
| 77 | } | ||
| 78 | |||
| 79 | if ((ret = GetNetworkParams(FixedInfo, &BufLen)) != ERROR_SUCCESS) { | ||
| 80 | printf("GetNetworkParams failed. ret = %08x\n", (u_int)ret ); | ||
| 81 | if (FixedInfo) { | ||
| 82 | GlobalFree(FixedInfo); | ||
| 83 | FixedInfo = NULL((void*)0); | ||
| 84 | } | ||
| 85 | return -1; | ||
| 86 | } | ||
| 87 | |||
| 88 | pIPAddr = &(FixedInfo->DnsServerList); | ||
| 89 | inet_aton(pIPAddr->IpAddress.String, &tmp_addr); | ||
| 90 | *pdns_addr = tmp_addr; | ||
| 91 | dns_addr = tmp_addr; | ||
| 92 | dns_addr_time = curtime; | ||
| 93 | if (FixedInfo) { | ||
| 94 | GlobalFree(FixedInfo); | ||
| 95 | FixedInfo = NULL((void*)0); | ||
| 96 | } | ||
| 97 | return 0; | ||
| 98 | } | ||
| 99 | |||
| 100 | static void winsock_cleanup(void) | ||
| 101 | { | ||
| 102 | WSACleanup(); | ||
| 103 | } | ||
| 104 | |||
| 105 | #else | ||
| 106 | |||
| 107 | static struct stat dns_addr_stat; | ||
| 108 | |||
| 109 | int get_dns_addr(struct in_addr *pdns_addr) | ||
| 110 | { | ||
| 111 | char buff[512]; | ||
| 112 | char buff2[257]; | ||
| 113 | FILE *f; | ||
| 114 | int found = 0; | ||
| 115 | struct in_addr tmp_addr; | ||
| 116 | |||
| 117 | if (dns_addr.s_addr != 0) { | ||
| 118 | struct stat old_stat; | ||
| 119 | if ((curtime - dns_addr_time) < 1000) { | ||
| 120 | *pdns_addr = dns_addr; | ||
| 121 | return 0; | ||
| 122 | } | ||
| 123 | old_stat = dns_addr_stat; | ||
| 124 | if (stat("/etc/resolv.conf", &dns_addr_stat) != 0) | ||
| 125 | return -1; | ||
| 126 | if ((dns_addr_stat.st_dev == old_stat.st_dev) | ||
| 127 | && (dns_addr_stat.st_ino == old_stat.st_ino) | ||
| 128 | && (dns_addr_stat.st_size == old_stat.st_size) | ||
| 129 | && (dns_addr_stat.st_mtimest_mtim.tv_sec == old_stat.st_mtimest_mtim.tv_sec)) { | ||
| 130 | *pdns_addr = dns_addr; | ||
| 131 | return 0; | ||
| 132 | } | ||
| 133 | } | ||
| 134 | |||
| 135 | f = fopen("/etc/resolv.conf", "r"); | ||
| 136 | if (!f) | ||
| 137 | return -1; | ||
| 138 | |||
| 139 | #ifdef DEBUG | ||
| 140 | lprint("IP address of your DNS(s): "); | ||
| 141 | #endif | ||
| 142 | while (fgets(buff, 512, f) != NULL((void*)0)) { | ||
| 143 | if (sscanf(buff, "nameserver%*[ \t]%256s", buff2) == 1) { | ||
| 144 | if (!inet_aton(buff2, &tmp_addr)) | ||
| 145 | continue; | ||
| 146 | /* If it's the first one, set it to dns_addr */ | ||
| 147 | if (!found) { | ||
| 148 | *pdns_addr = tmp_addr; | ||
| 149 | dns_addr = tmp_addr; | ||
| 150 | dns_addr_time = curtime; | ||
| 151 | } | ||
| 152 | #ifdef DEBUG | ||
| 153 | else | ||
| 154 | lprint(", "); | ||
| 155 | #endif | ||
| 156 | if (++found > 3) { | ||
| 157 | #ifdef DEBUG | ||
| 158 | lprint("(more)"); | ||
| 159 | #endif | ||
| 160 | break; | ||
| 161 | } | ||
| 162 | #ifdef DEBUG | ||
| 163 | else | ||
| 164 | lprint("%s", inet_ntoa(tmp_addr)); | ||
| 165 | #endif | ||
| 166 | } | ||
| 167 | } | ||
| 168 | fclose(f); | ||
| 169 | if (!found) | ||
| 170 | return -1; | ||
| 171 | return 0; | ||
| 172 | } | ||
| 173 | |||
| 174 | #endif | ||
| 175 | |||
| 176 | static void slirp_init_once(void) | ||
| 177 | { | ||
| 178 | static int initialized; | ||
| 179 | #ifdef _WIN32 | ||
| 180 | WSADATA Data; | ||
| 181 | #endif | ||
| 182 | |||
| 183 | if (initialized) { | ||
| 184 | return; | ||
| 185 | } | ||
| 186 | initialized = 1; | ||
| 187 | |||
| 188 | #ifdef _WIN32 | ||
| 189 | WSAStartup(MAKEWORD(2,0), &Data); | ||
| 190 | atexit(winsock_cleanup); | ||
| 191 | #endif | ||
| 192 | |||
| 193 | loopback_addr.s_addr = htonl(INADDR_LOOPBACK((in_addr_t) 0x7f000001)); | ||
| 194 | } | ||
| 195 | |||
| 196 | static void slirp_state_save(QEMUFile *f, void *opaque); | ||
| 197 | static int slirp_state_load(QEMUFile *f, void *opaque, int version_id); | ||
| 198 | |||
| 199 | Slirp *slirp_init(int restricted, struct in_addr vnetwork, | ||
| 200 | struct in_addr vnetmask, struct in_addr vhost, | ||
| 201 | const char *vhostname, const char *tftp_path, | ||
| 202 | const char *bootfile, struct in_addr vdhcp_start, | ||
| 203 | struct in_addr vnameserver, void *opaque) | ||
| 204 | { | ||
| 205 | Slirp *slirp = g_malloc0(sizeof(Slirp)); | ||
| 206 | |||
| 207 | slirp_init_once(); | ||
| 208 | |||
| 209 | slirp->restricted = restricted; | ||
| 210 | |||
| 211 | if_init(slirp); | ||
| 212 | ip_init(slirp); | ||
| 213 | |||
| 214 | /* Initialise mbufs *after* setting the MTU */ | ||
| 215 | m_init(slirp); | ||
| 216 | |||
| 217 | slirp->vnetwork_addr = vnetwork; | ||
| 218 | slirp->vnetwork_mask = vnetmask; | ||
| 219 | slirp->vhost_addr = vhost; | ||
| 220 | if (vhostname) { | ||
| 221 | pstrcpy(slirp->client_hostname, sizeof(slirp->client_hostname), | ||
| 222 | vhostname); | ||
| 223 | } | ||
| 224 | if (tftp_path) { | ||
| 225 | slirp->tftp_prefix = g_strdup(tftp_path); | ||
| 226 | } | ||
| 227 | if (bootfile) { | ||
| 228 | slirp->bootp_filename = g_strdup(bootfile); | ||
| 229 | } | ||
| 230 | slirp->vdhcp_startaddr = vdhcp_start; | ||
| 231 | slirp->vnameserver_addr = vnameserver; | ||
| 232 | |||
| 233 | slirp->opaque = opaque; | ||
| 234 | |||
| 235 | register_savevm(NULL((void*)0), "slirp", 0, 3, | ||
| 236 | slirp_state_save, slirp_state_load, slirp); | ||
| 237 | |||
| 238 | QTAILQ_INSERT_TAIL(&slirp_instances, slirp, entry)do { (slirp)->entry.tqe_next = ((void*)0); (slirp)->entry .tqe_prev = (&slirp_instances)->tqh_last; *(&slirp_instances )->tqh_last = (slirp); (&slirp_instances)->tqh_last = &(slirp)->entry.tqe_next; } while ( 0); | ||
| 239 | |||
| 240 | return slirp; | ||
| 241 | } | ||
| 242 | |||
| 243 | void slirp_cleanup(Slirp *slirp) | ||
| 244 | { | ||
| 245 | QTAILQ_REMOVE(&slirp_instances, slirp, entry)do { if (((slirp)->entry.tqe_next) != ((void*)0)) (slirp)-> entry.tqe_next->entry.tqe_prev = (slirp)->entry.tqe_prev ; else (&slirp_instances)->tqh_last = (slirp)->entry .tqe_prev; *(slirp)->entry.tqe_prev = (slirp)->entry.tqe_next ; } while ( 0); | ||
| 246 | |||
| 247 | unregister_savevm(NULL((void*)0), "slirp", slirp); | ||
| 248 | |||
| 249 | ip_cleanup(slirp); | ||
| 250 | m_cleanup(slirp); | ||
| 251 | |||
| 252 | g_free(slirp->tftp_prefix); | ||
| 253 | g_free(slirp->bootp_filename); | ||
| 254 | g_free(slirp); | ||
| 255 | } | ||
| 256 | |||
| 257 | #define CONN_CANFSEND(so)(((so)->so_state & (0x010|0x004)) == 0x004) (((so)->so_state & (SS_FCANTSENDMORE0x010|SS_ISFCONNECTED0x004)) == SS_ISFCONNECTED0x004) | ||
| 258 | #define CONN_CANFRCV(so)(((so)->so_state & (0x008|0x004)) == 0x004) (((so)->so_state & (SS_FCANTRCVMORE0x008|SS_ISFCONNECTED0x004)) == SS_ISFCONNECTED0x004) | ||
| 259 | #define UPD_NFDS(x)if (nfds < (x)) nfds = (x) if (nfds < (x)) nfds = (x) | ||
| 260 | |||
| 261 | void slirp_update_timeout(uint32_t *timeout) | ||
| 262 | { | ||
| 263 | if (!QTAILQ_EMPTY(&slirp_instances)((&slirp_instances)->tqh_first == ((void*)0))) { | ||
| 264 | *timeout = MIN(1000, *timeout)(((1000) < (*timeout)) ? (1000) : (*timeout)); | ||
| 265 | } | ||
| 266 | } | ||
| 267 | |||
| 268 | void slirp_select_fill(int *pnfds, | ||
| 269 | fd_set *readfds, fd_set *writefds, fd_set *xfds) | ||
| 270 | { | ||
| 271 | Slirp *slirp; | ||
| 272 | struct socket *so, *so_next; | ||
| 273 | int nfds; | ||
| 274 | |||
| 275 | if (QTAILQ_EMPTY(&slirp_instances)((&slirp_instances)->tqh_first == ((void*)0))) { | ||
| 276 | return; | ||
| 277 | } | ||
| 278 | |||
| 279 | /* fail safe */ | ||
| 280 | global_readfds = NULL((void*)0); | ||
| 281 | global_writefds = NULL((void*)0); | ||
| 282 | global_xfds = NULL((void*)0); | ||
| 283 | |||
| 284 | nfds = *pnfds; | ||
| 285 | /* | ||
| 286 | * First, TCP sockets | ||
| 287 | */ | ||
| 288 | do_slowtimo = 0; | ||
| 289 | |||
| 290 | QTAILQ_FOREACH(slirp, &slirp_instances, entry)for ((slirp) = ((&slirp_instances)->tqh_first); (slirp ); (slirp) = ((slirp)->entry.tqe_next)) { | ||
| 291 | /* | ||
| 292 | * *_slowtimo needs calling if there are IP fragments | ||
| 293 | * in the fragment queue, or there are TCP connections active | ||
| 294 | */ | ||
| 295 | do_slowtimo |= ((slirp->tcb.so_next != &slirp->tcb) || | ||
| 296 | (&slirp->ipq.ip_link != slirp->ipq.ip_link.next)); | ||
| 297 | |||
| 298 | for (so = slirp->tcb.so_next; so != &slirp->tcb; | ||
| 299 | so = so_next) { | ||
| 300 | so_next = so->so_next; | ||
| 301 | |||
| 302 | /* | ||
| 303 | * See if we need a tcp_fasttimo | ||
| 304 | */ | ||
| 305 | if (time_fasttimo == 0 && so->so_tcpcb->t_flags & TF_DELACK0x0002) | ||
| 306 | time_fasttimo = curtime; /* Flag when we want a fasttimo */ | ||
| 307 | |||
| 308 | /* | ||
| 309 | * NOFDREF can include still connecting to local-host, | ||
| 310 | * newly socreated() sockets etc. Don't want to select these. | ||
| 311 | */ | ||
| 312 | if (so->so_state & SS_NOFDREF0x001 || so->s == -1) | ||
| 313 | continue; | ||
| 314 | |||
| 315 | /* | ||
| 316 | * Set for reading sockets which are accepting | ||
| 317 | */ | ||
| 318 | if (so->so_state & SS_FACCEPTCONN0x100) { | ||
| 319 | FD_SET(so->s, readfds)(((readfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] |= ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))); | ||
| 320 | UPD_NFDS(so->s)if (nfds < (so->s)) nfds = (so->s); | ||
| 321 | continue; | ||
| 322 | } | ||
| 323 | |||
| 324 | /* | ||
| 325 | * Set for writing sockets which are connecting | ||
| 326 | */ | ||
| 327 | if (so->so_state & SS_ISFCONNECTING0x002) { | ||
| 328 | FD_SET(so->s, writefds)(((writefds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] |= ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))); | ||
| 329 | UPD_NFDS(so->s)if (nfds < (so->s)) nfds = (so->s); | ||
| 330 | continue; | ||
| 331 | } | ||
| 332 | |||
| 333 | /* | ||
| 334 | * Set for writing if we are connected, can send more, and | ||
| 335 | * we have something to send | ||
| 336 | */ | ||
| 337 | if (CONN_CANFSEND(so)(((so)->so_state & (0x010|0x004)) == 0x004) && so->so_rcv.sb_cc) { | ||
| 338 | FD_SET(so->s, writefds)(((writefds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] |= ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))); | ||
| 339 | UPD_NFDS(so->s)if (nfds < (so->s)) nfds = (so->s); | ||
| 340 | } | ||
| 341 | |||
| 342 | /* | ||
| 343 | * Set for reading (and urgent data) if we are connected, can | ||
| 344 | * receive more, and we have room for it XXX /2 ? | ||
| 345 | */ | ||
| 346 | if (CONN_CANFRCV(so)(((so)->so_state & (0x008|0x004)) == 0x004) && (so->so_snd.sb_cc < (so->so_snd.sb_datalen/2))) { | ||
| 347 | FD_SET(so->s, readfds)(((readfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] |= ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))); | ||
| 348 | FD_SET(so->s, xfds)(((xfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] |= ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))); | ||
| 349 | UPD_NFDS(so->s)if (nfds < (so->s)) nfds = (so->s); | ||
| 350 | } | ||
| 351 | } | ||
| 352 | |||
| 353 | /* | ||
| 354 | * UDP sockets | ||
| 355 | */ | ||
| 356 | for (so = slirp->udb.so_next; so != &slirp->udb; | ||
| 357 | so = so_next) { | ||
| 358 | so_next = so->so_next; | ||
| 359 | |||
| 360 | /* | ||
| 361 | * See if it's timed out | ||
| 362 | */ | ||
| 363 | if (so->so_expire) { | ||
| 364 | if (so->so_expire <= curtime) { | ||
| 365 | udp_detach(so); | ||
| 366 | continue; | ||
| 367 | } else | ||
| 368 | do_slowtimo = 1; /* Let socket expire */ | ||
| 369 | } | ||
| 370 | |||
| 371 | /* | ||
| 372 | * When UDP packets are received from over the | ||
| 373 | * link, they're sendto()'d straight away, so | ||
| 374 | * no need for setting for writing | ||
| 375 | * Limit the number of packets queued by this session | ||
| 376 | * to 4. Note that even though we try and limit this | ||
| 377 | * to 4 packets, the session could have more queued | ||
| 378 | * if the packets needed to be fragmented | ||
| 379 | * (XXX <= 4 ?) | ||
| 380 | */ | ||
| 381 | if ((so->so_state & SS_ISFCONNECTED0x004) && so->so_queued <= 4) { | ||
| 382 | FD_SET(so->s, readfds)(((readfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] |= ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))); | ||
| 383 | UPD_NFDS(so->s)if (nfds < (so->s)) nfds = (so->s); | ||
| 384 | } | ||
| 385 | } | ||
| 386 | |||
| 387 | /* | ||
| 388 | * ICMP sockets | ||
| 389 | */ | ||
| 390 | for (so = slirp->icmp.so_next; so != &slirp->icmp; | ||
| 391 | so = so_next) { | ||
| 392 | so_next = so->so_next; | ||
| 393 | |||
| 394 | /* | ||
| 395 | * See if it's timed out | ||
| 396 | */ | ||
| 397 | if (so->so_expire) { | ||
| 398 | if (so->so_expire <= curtime) { | ||
| 399 | icmp_detach(so); | ||
| 400 | continue; | ||
| 401 | } else { | ||
| 402 | do_slowtimo = 1; /* Let socket expire */ | ||
| 403 | } | ||
| 404 | } | ||
| 405 | |||
| 406 | if (so->so_state & SS_ISFCONNECTED0x004) { | ||
| 407 | FD_SET(so->s, readfds)(((readfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] |= ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))); | ||
| 408 | UPD_NFDS(so->s)if (nfds < (so->s)) nfds = (so->s); | ||
| 409 | } | ||
| 410 | } | ||
| 411 | } | ||
| 412 | |||
| 413 | *pnfds = nfds; | ||
| 414 | } | ||
| 415 | |||
| 416 | void slirp_select_poll(fd_set *readfds, fd_set *writefds, fd_set *xfds, | ||
| 417 | int select_error) | ||
| 418 | { | ||
| 419 | Slirp *slirp; | ||
| 420 | struct socket *so, *so_next; | ||
| 421 | int ret; | ||
| 422 | |||
| 423 | if (QTAILQ_EMPTY(&slirp_instances)((&slirp_instances)->tqh_first == ((void*)0))) { | ||
| 424 | return; | ||
| 425 | } | ||
| 426 | |||
| 427 | global_readfds = readfds; | ||
| 428 | global_writefds = writefds; | ||
| 429 | global_xfds = xfds; | ||
| 430 | |||
| 431 | curtime = qemu_get_clock_ms(rt_clock); | ||
| 432 | |||
| 433 | QTAILQ_FOREACH(slirp, &slirp_instances, entry)for ((slirp) = ((&slirp_instances)->tqh_first); (slirp ); (slirp) = ((slirp)->entry.tqe_next)) { | ||
| 434 | /* | ||
| 435 | * See if anything has timed out | ||
| 436 | */ | ||
| 437 | if (time_fasttimo && ((curtime - time_fasttimo) >= 2)) { | ||
| 438 | tcp_fasttimo(slirp); | ||
| 439 | time_fasttimo = 0; | ||
| 440 | } | ||
| 441 | if (do_slowtimo && ((curtime - last_slowtimo) >= 499)) { | ||
| 442 | ip_slowtimo(slirp); | ||
| 443 | tcp_slowtimo(slirp); | ||
| 444 | last_slowtimo = curtime; | ||
| 445 | } | ||
| 446 | |||
| 447 | /* | ||
| 448 | * Check sockets | ||
| 449 | */ | ||
| 450 | if (!select_error) { | ||
| 451 | /* | ||
| 452 | * Check TCP sockets | ||
| 453 | */ | ||
| 454 | for (so = slirp->tcb.so_next; so != &slirp->tcb; | ||
| 455 | so = so_next) { | ||
| 456 | so_next = so->so_next; | ||
| 457 | |||
| 458 | /* | ||
| 459 | * FD_ISSET is meaningless on these sockets | ||
| 460 | * (and they can crash the program) | ||
| 461 | */ | ||
| 462 | if (so->so_state & SS_NOFDREF0x001 || so->s == -1) | ||
| 463 | continue; | ||
| 464 | |||
| 465 | /* | ||
| 466 | * Check for URG data | ||
| 467 | * This will soread as well, so no need to | ||
| 468 | * test for readfds below if this succeeds | ||
| 469 | */ | ||
| 470 | if (FD_ISSET(so->s, xfds)((((xfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] & ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))) != 0)) | ||
| 471 | sorecvoob(so); | ||
| 472 | /* | ||
| 473 | * Check sockets for reading | ||
| 474 | */ | ||
| 475 | else if (FD_ISSET(so->s, readfds)((((readfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] & ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))) != 0)) { | ||
| 476 | /* | ||
| 477 | * Check for incoming connections | ||
| 478 | */ | ||
| 479 | if (so->so_state & SS_FACCEPTCONN0x100) { | ||
| 480 | tcp_connect(so); | ||
| 481 | continue; | ||
| 482 | } /* else */ | ||
| 483 | ret = soread(so); | ||
| 484 | |||
| 485 | /* Output it if we read something */ | ||
| 486 | if (ret > 0) | ||
| 487 | tcp_output(sototcpcb(so)((so)->so_tcpcb)); | ||
| 488 | } | ||
| 489 | |||
| 490 | /* | ||
| 491 | * Check sockets for writing | ||
| 492 | */ | ||
| 493 | if (FD_ISSET(so->s, writefds)((((writefds)->fds_bits)[((so->s) / (8 * (int) sizeof ( __fd_mask)))] & ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))) != 0)) { | ||
| 494 | /* | ||
| 495 | * Check for non-blocking, still-connecting sockets | ||
| 496 | */ | ||
| 497 | if (so->so_state & SS_ISFCONNECTING0x002) { | ||
| 498 | /* Connected */ | ||
| 499 | so->so_state &= ~SS_ISFCONNECTING0x002; | ||
| 500 | |||
| 501 | ret = send(so->s, (const void *) &ret, 0, 0); | ||
| 502 | if (ret < 0) { | ||
| 503 | /* XXXXX Must fix, zero bytes is a NOP */ | ||
| 504 | if (errno(*__errno_location ()) == EAGAIN11 || errno(*__errno_location ()) == EWOULDBLOCK11 || | ||
| 505 | errno(*__errno_location ()) == EINPROGRESS115 || errno(*__errno_location ()) == ENOTCONN107) | ||
| 506 | continue; | ||
| 507 | |||
| 508 | /* else failed */ | ||
| 509 | so->so_state &= SS_PERSISTENT_MASK0xf000; | ||
| 510 | so->so_state |= SS_NOFDREF0x001; | ||
| 511 | } | ||
| 512 | /* else so->so_state &= ~SS_ISFCONNECTING; */ | ||
| 513 | |||
| 514 | /* | ||
| 515 | * Continue tcp_input | ||
| 516 | */ | ||
| 517 | tcp_input((struct mbuf *)NULL((void*)0), sizeof(struct ip), so); | ||
| 518 | /* continue; */ | ||
| 519 | } else | ||
| 520 | ret = sowrite(so); | ||
| 521 | /* | ||
| 522 | * XXXXX If we wrote something (a lot), there | ||
| 523 | * could be a need for a window update. | ||
| 524 | * In the worst case, the remote will send | ||
| 525 | * a window probe to get things going again | ||
| 526 | */ | ||
| 527 | } | ||
| 528 | |||
| 529 | /* | ||
| 530 | * Probe a still-connecting, non-blocking socket | ||
| 531 | * to check if it's still alive | ||
| 532 | */ | ||
| 533 | #ifdef PROBE_CONN | ||
| 534 | if (so->so_state & SS_ISFCONNECTING0x002) { | ||
| 535 | ret = qemu_recv(so->s, &ret, 0,0)recv(so->s, &ret, 0, 0); | ||
| 536 | |||
| 537 | if (ret < 0) { | ||
| 538 | /* XXX */ | ||
| 539 | if (errno(*__errno_location ()) == EAGAIN11 || errno(*__errno_location ()) == EWOULDBLOCK11 || | ||
| 540 | errno(*__errno_location ()) == EINPROGRESS115 || errno(*__errno_location ()) == ENOTCONN107) | ||
| 541 | continue; /* Still connecting, continue */ | ||
| 542 | |||
| 543 | /* else failed */ | ||
| 544 | so->so_state &= SS_PERSISTENT_MASK0xf000; | ||
| 545 | so->so_state |= SS_NOFDREF0x001; | ||
| 546 | |||
| 547 | /* tcp_input will take care of it */ | ||
| 548 | } else { | ||
| 549 | ret = send(so->s, &ret, 0,0); | ||
| 550 | if (ret < 0) { | ||
| 551 | /* XXX */ | ||
| 552 | if (errno(*__errno_location ()) == EAGAIN11 || errno(*__errno_location ()) == EWOULDBLOCK11 || | ||
| 553 | errno(*__errno_location ()) == EINPROGRESS115 || errno(*__errno_location ()) == ENOTCONN107) | ||
| 554 | continue; | ||
| 555 | /* else failed */ | ||
| 556 | so->so_state &= SS_PERSISTENT_MASK0xf000; | ||
| 557 | so->so_state |= SS_NOFDREF0x001; | ||
| 558 | } else | ||
| 559 | so->so_state &= ~SS_ISFCONNECTING0x002; | ||
| 560 | |||
| 561 | } | ||
| 562 | tcp_input((struct mbuf *)NULL((void*)0), sizeof(struct ip),so); | ||
| 563 | } /* SS_ISFCONNECTING */ | ||
| 564 | #endif | ||
| 565 | } | ||
| 566 | |||
| 567 | /* | ||
| 568 | * Now UDP sockets. | ||
| 569 | * Incoming packets are sent straight away, they're not buffered. | ||
| 570 | * Incoming UDP data isn't buffered either. | ||
| 571 | */ | ||
| 572 | for (so = slirp->udb.so_next; so != &slirp->udb; | ||
| 573 | so = so_next) { | ||
| 574 | so_next = so->so_next; | ||
| 575 | |||
| 576 | if (so->s != -1 && FD_ISSET(so->s, readfds)((((readfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] & ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))) != 0)) { | ||
| 577 | sorecvfrom(so); | ||
| 578 | } | ||
| 579 | } | ||
| 580 | |||
| 581 | /* | ||
| 582 | * Check incoming ICMP relies. | ||
| 583 | */ | ||
| 584 | for (so = slirp->icmp.so_next; so != &slirp->icmp; | ||
| 585 | so = so_next) { | ||
| 586 | so_next = so->so_next; | ||
| 587 | |||
| 588 | if (so->s != -1 && FD_ISSET(so->s, readfds)((((readfds)->fds_bits)[((so->s) / (8 * (int) sizeof (__fd_mask )))] & ((__fd_mask) 1 << ((so->s) % (8 * (int) sizeof (__fd_mask))))) != 0)) { | ||
| 589 | icmp_receive(so); | ||
| 590 | } | ||
| 591 | } | ||
| 592 | } | ||
| 593 | |||
| 594 | if_start(slirp); | ||
| 595 | } | ||
| 596 | |||
| 597 | /* clear global file descriptor sets. | ||
| 598 | * these reside on the stack in vl.c | ||
| 599 | * so they're unusable if we're not in | ||
| 600 | * slirp_select_fill or slirp_select_poll. | ||
| 601 | */ | ||
| 602 | global_readfds = NULL((void*)0); | ||
| 603 | global_writefds = NULL((void*)0); | ||
| 604 | global_xfds = NULL((void*)0); | ||
| 605 | } | ||
| 606 | |||
| 607 | static void arp_input(Slirp *slirp, const uint8_t *pkt, int pkt_len) | ||
| 608 | { | ||
| 609 | struct arphdr *ah = (struct arphdr *)(pkt + ETH_HLEN14); | ||
| 610 | uint8_t arp_reply[max(ETH_HLEN + sizeof(struct arphdr), 64)((14 + sizeof(struct arphdr)) > (64) ? (14 + sizeof(struct arphdr)) : (64))]; | ||
| 611 | struct ethhdr *reh = (struct ethhdr *)arp_reply; | ||
| 612 | struct arphdr *rah = (struct arphdr *)(arp_reply + ETH_HLEN14); | ||
| 613 | int ar_op; | ||
| 614 | struct ex_list *ex_ptr; | ||
| 615 | |||
| 616 | ar_op = ntohs(ah->ar_op); | ||
| 617 | switch(ar_op) { | ||
| 618 | case ARPOP_REQUEST1: | ||
| 619 | if (ah->ar_tip == ah->ar_sip) { | ||
| 620 | /* Gratuitous ARP */ | ||
| 621 | arp_table_add(slirp, ah->ar_sip, ah->ar_sha); | ||
| 622 | return; | ||
| 623 | } | ||
| 624 | |||
| 625 | if ((ah->ar_tip & slirp->vnetwork_mask.s_addr) == | ||
| 626 | slirp->vnetwork_addr.s_addr) { | ||
| 627 | if (ah->ar_tip == slirp->vnameserver_addr.s_addr || | ||
| 628 | ah->ar_tip == slirp->vhost_addr.s_addr) | ||
| 629 | goto arp_ok; | ||
| 630 | for (ex_ptr = slirp->exec_list; ex_ptr; ex_ptr = ex_ptr->ex_next) { | ||
| 631 | if (ex_ptr->ex_addr.s_addr == ah->ar_tip) | ||
| 632 | goto arp_ok; | ||
| 633 | } | ||
| 634 | return; | ||
| 635 | arp_ok: | ||
| 636 | memset(arp_reply, 0, sizeof(arp_reply)); | ||
| 637 | |||
| 638 | arp_table_add(slirp, ah->ar_sip, ah->ar_sha); | ||
| 639 | |||
| 640 | /* ARP request for alias/dns mac address */ | ||
| 641 | memcpy(reh->h_dest, pkt + ETH_ALEN6, ETH_ALEN6); | ||
| 642 | memcpy(reh->h_source, special_ethaddr, ETH_ALEN6 - 4); | ||
| 643 | memcpy(&reh->h_source[2], &ah->ar_tip, 4); | ||
| 644 | reh->h_proto = htons(ETH_P_ARP0x0806); | ||
| 645 | |||
| 646 | rah->ar_hrd = htons(1); | ||
| 647 | rah->ar_pro = htons(ETH_P_IP0x0800); | ||
| 648 | rah->ar_hln = ETH_ALEN6; | ||
| 649 | rah->ar_pln = 4; | ||
| 650 | rah->ar_op = htons(ARPOP_REPLY2); | ||
| 651 | memcpy(rah->ar_sha, reh->h_source, ETH_ALEN6); | ||
| 652 | rah->ar_sip = ah->ar_tip; | ||
| 653 | memcpy(rah->ar_tha, ah->ar_sha, ETH_ALEN6); | ||
| 654 | rah->ar_tip = ah->ar_sip; | ||
| 655 | slirp_output(slirp->opaque, arp_reply, sizeof(arp_reply)); | ||
| 656 | } | ||
| 657 | break; | ||
| 658 | case ARPOP_REPLY2: | ||
| 659 | arp_table_add(slirp, ah->ar_sip, ah->ar_sha); | ||
| 660 | break; | ||
| 661 | default: | ||
| 662 | break; | ||
| 663 | } | ||
| 664 | } | ||
| 665 | |||
| 666 | void slirp_input(Slirp *slirp, const uint8_t *pkt, int pkt_len) | ||
| 667 | { | ||
| 668 | struct mbuf *m; | ||
| 669 | int proto; | ||
| 670 | |||
| 671 | if (pkt_len < ETH_HLEN14) | ||
| 672 | return; | ||
| 673 | |||
| 674 | proto = ntohs(*(uint16_t *)(pkt + 12)); | ||
| 675 | switch(proto) { | ||
| 676 | case ETH_P_ARP0x0806: | ||
| 677 | arp_input(slirp, pkt, pkt_len); | ||
| 678 | break; | ||
| 679 | case ETH_P_IP0x0800: | ||
| 680 | m = m_get(slirp); | ||
| 681 | if (!m) | ||
| 682 | return; | ||
| 683 | /* Note: we add to align the IP header */ | ||
| 684 | if (M_FREEROOM(m)(((m->m_hdr.mh_flags & 0x01)? (((m)->M_dat.m_ext_ + (m)->m_hdr.mh_size) - (m)->m_hdr.mh_data) : (((m)-> M_dat.m_dat_ + (m)->m_hdr.mh_size) - (m)->m_hdr.mh_data )) - (m)->m_hdr.mh_len) < pkt_len + 2) { | ||
| 685 | m_inc(m, pkt_len + 2); | ||
| 686 | } | ||
| 687 | m->m_lenm_hdr.mh_len = pkt_len + 2; | ||
| 688 | memcpy(m->m_datam_hdr.mh_data + 2, pkt, pkt_len); | ||
| 689 | |||
| 690 | m->m_datam_hdr.mh_data += 2 + ETH_HLEN14; | ||
| 691 | m->m_lenm_hdr.mh_len -= 2 + ETH_HLEN14; | ||
| 692 | |||
| 693 | ip_input(m); | ||
| 694 | break; | ||
| 695 | default: | ||
| 696 | break; | ||
| 697 | } | ||
| 698 | } | ||
| 699 | |||
| 700 | /* Output the IP packet to the ethernet device. Returns 0 if the packet must be | ||
| 701 | * re-queued. | ||
| 702 | */ | ||
| 703 | int if_encap(Slirp *slirp, struct mbuf *ifm) | ||
| 704 | { | ||
| 705 | uint8_t buf[1600]; | ||
| 706 | struct ethhdr *eh = (struct ethhdr *)buf; | ||
| 707 | uint8_t ethaddr[ETH_ALEN6]; | ||
| 708 | const struct ip *iph = (const struct ip *)ifm->m_datam_hdr.mh_data; | ||
| 709 | |||
| 710 | if (ifm->m_lenm_hdr.mh_len + ETH_HLEN14 > sizeof(buf)) { | ||
| 711 | return 1; | ||
| 712 | } | ||
| 713 | |||
| 714 | if (!arp_table_search(slirp, iph->ip_dst.s_addr, ethaddr)) { | ||
| 715 | uint8_t arp_req[ETH_HLEN14 + sizeof(struct arphdr)]; | ||
| 716 | struct ethhdr *reh = (struct ethhdr *)arp_req; | ||
| 717 | struct arphdr *rah = (struct arphdr *)(arp_req + ETH_HLEN14); | ||
| 718 | |||
| 719 | if (!ifm->arp_requested) { | ||
| 720 | /* If the client addr is not known, send an ARP request */ | ||
| 721 | memset(reh->h_dest, 0xff, ETH_ALEN6); | ||
| 722 | memcpy(reh->h_source, special_ethaddr, ETH_ALEN6 - 4); | ||
| 723 | memcpy(&reh->h_source[2], &slirp->vhost_addr, 4); | ||
| 724 | reh->h_proto = htons(ETH_P_ARP0x0806); | ||
| 725 | rah->ar_hrd = htons(1); | ||
| 726 | rah->ar_pro = htons(ETH_P_IP0x0800); | ||
| 727 | rah->ar_hln = ETH_ALEN6; | ||
| 728 | rah->ar_pln = 4; | ||
| 729 | rah->ar_op = htons(ARPOP_REQUEST1); | ||
| 730 | |||
| 731 | /* source hw addr */ | ||
| 732 | memcpy(rah->ar_sha, special_ethaddr, ETH_ALEN6 - 4); | ||
| 733 | memcpy(&rah->ar_sha[2], &slirp->vhost_addr, 4); | ||
| 734 | |||
| 735 | /* source IP */ | ||
| 736 | rah->ar_sip = slirp->vhost_addr.s_addr; | ||
| 737 | |||
| 738 | /* target hw addr (none) */ | ||
| 739 | memset(rah->ar_tha, 0, ETH_ALEN6); | ||
| 740 | |||
| 741 | /* target IP */ | ||
| 742 | rah->ar_tip = iph->ip_dst.s_addr; | ||
| 743 | slirp->client_ipaddr = iph->ip_dst; | ||
| 744 | slirp_output(slirp->opaque, arp_req, sizeof(arp_req)); | ||
| 745 | ifm->arp_requested = true1; | ||
| 746 | |||
| 747 | /* Expire request and drop outgoing packet after 1 second */ | ||
| 748 | ifm->expiration_date = qemu_get_clock_ns(rt_clock) + 1000000000ULL; | ||
| 749 | } | ||
| 750 | return 0; | ||
| 751 | } else { | ||
| 752 | memcpy(eh->h_dest, ethaddr, ETH_ALEN6); | ||
| 753 | memcpy(eh->h_source, special_ethaddr, ETH_ALEN6 - 4); | ||
| 754 | /* XXX: not correct */ | ||
| 755 | memcpy(&eh->h_source[2], &slirp->vhost_addr, 4); | ||
| 756 | eh->h_proto = htons(ETH_P_IP0x0800); | ||
| 757 | memcpy(buf + sizeof(struct ethhdr), ifm->m_datam_hdr.mh_data, ifm->m_lenm_hdr.mh_len); | ||
| 758 | slirp_output(slirp->opaque, buf, ifm->m_lenm_hdr.mh_len + ETH_HLEN14); | ||
| 759 | return 1; | ||
| 760 | } | ||
| 761 | } | ||
| 762 | |||
| 763 | /* Drop host forwarding rule, return 0 if found. */ | ||
| 764 | int slirp_remove_hostfwd(Slirp *slirp, int is_udp, struct in_addr host_addr, | ||
| 765 | int host_port) | ||
| 766 | { | ||
| 767 | struct socket *so; | ||
| 768 | struct socket *head = (is_udp ? &slirp->udb : &slirp->tcb); | ||
| |||
| 769 | struct sockaddr_in addr; | ||
| 770 | int port = htons(host_port); | ||
| 771 | socklen_t addr_len; | ||
| 772 | |||
| 773 | for (so = head->so_next; so != head; so = so->so_next) { | ||
| |||
| 774 | addr_len = sizeof(addr); | ||
| 775 | if ((so->so_state & SS_HOSTFWD0x1000) && | ||
| 776 | getsockname(so->s, (struct sockaddr *)&addr, &addr_len) == 0 && | ||
| 777 | addr.sin_addr.s_addr == host_addr.s_addr && | ||
| |||
| 778 | addr.sin_port == port) { | ||
| 779 | close(so->s); | ||
| 780 | sofree(so); | ||
| 781 | return 0; | ||
| 782 | } | ||
| 783 | } | ||
| 784 | |||
| 785 | return -1; | ||
| 786 | } | ||
| 787 | |||
| 788 | int slirp_add_hostfwd(Slirp *slirp, int is_udp, struct in_addr host_addr, | ||
| 789 | int host_port, struct in_addr guest_addr, int guest_port) | ||
| 790 | { | ||
| 791 | if (!guest_addr.s_addr) { | ||
| 792 | guest_addr = slirp->vdhcp_startaddr; | ||
| 793 | } | ||
| 794 | if (is_udp) { | ||
| 795 | if (!udp_listen(slirp, host_addr.s_addr, htons(host_port), | ||
| 796 | guest_addr.s_addr, htons(guest_port), SS_HOSTFWD0x1000)) | ||
| 797 | return -1; | ||
| 798 | } else { | ||
| 799 | if (!tcp_listen(slirp, host_addr.s_addr, htons(host_port), | ||
| 800 | guest_addr.s_addr, htons(guest_port), SS_HOSTFWD0x1000)) | ||
| 801 | return -1; | ||
| 802 | } | ||
| 803 | return 0; | ||
| 804 | } | ||
| 805 | |||
| 806 | int slirp_add_exec(Slirp *slirp, int do_pty, const void *args, | ||
| 807 | struct in_addr *guest_addr, int guest_port) | ||
| 808 | { | ||
| 809 | if (!guest_addr->s_addr) { | ||
| 810 | guest_addr->s_addr = slirp->vnetwork_addr.s_addr | | ||
| 811 | (htonl(0x0204) & ~slirp->vnetwork_mask.s_addr); | ||
| 812 | } | ||
| 813 | if ((guest_addr->s_addr & slirp->vnetwork_mask.s_addr) != | ||
| 814 | slirp->vnetwork_addr.s_addr || | ||
| 815 | guest_addr->s_addr == slirp->vhost_addr.s_addr || | ||
| 816 | guest_addr->s_addr == slirp->vnameserver_addr.s_addr) { | ||
| 817 | return -1; | ||
| 818 | } | ||
| 819 | return add_exec(&slirp->exec_list, do_pty, (char *)args, *guest_addr, | ||
| 820 | htons(guest_port)); | ||
| 821 | } | ||
| 822 | |||
| 823 | ssize_t slirp_send(struct socket *so, const void *buf, size_t len, int flags) | ||
| 824 | { | ||
| 825 | if (so->s == -1 && so->extra) { | ||
| 826 | qemu_chr_fe_write(so->extra, buf, len); | ||
| 827 | return len; | ||
| 828 | } | ||
| 829 | |||
| 830 | return send(so->s, buf, len, flags); | ||
| 831 | } | ||
| 832 | |||
| 833 | static struct socket * | ||
| 834 | slirp_find_ctl_socket(Slirp *slirp, struct in_addr guest_addr, int guest_port) | ||
| 835 | { | ||
| 836 | struct socket *so; | ||
| 837 | |||
| 838 | for (so = slirp->tcb.so_next; so != &slirp->tcb; so = so->so_next) { | ||
| 839 | if (so->so_faddr.s_addr == guest_addr.s_addr && | ||
| 840 | htons(so->so_fport) == guest_port) { | ||
| 841 | return so; | ||
| 842 | } | ||
| 843 | } | ||
| 844 | return NULL((void*)0); | ||
| 845 | } | ||
| 846 | |||
| 847 | size_t slirp_socket_can_recv(Slirp *slirp, struct in_addr guest_addr, | ||
| 848 | int guest_port) | ||
| 849 | { | ||
| 850 | struct iovec iov[2]; | ||
| 851 | struct socket *so; | ||
| 852 | |||
| 853 | so = slirp_find_ctl_socket(slirp, guest_addr, guest_port); | ||
| 854 | |||
| 855 | if (!so || so->so_state & SS_NOFDREF0x001) | ||
| 856 | return 0; | ||
| 857 | |||
| 858 | if (!CONN_CANFRCV(so)(((so)->so_state & (0x008|0x004)) == 0x004) || so->so_snd.sb_cc >= (so->so_snd.sb_datalen/2)) | ||
| 859 | return 0; | ||
| 860 | |||
| 861 | return sopreprbuf(so, iov, NULL((void*)0)); | ||
| 862 | } | ||
| 863 | |||
| 864 | void slirp_socket_recv(Slirp *slirp, struct in_addr guest_addr, int guest_port, | ||
| 865 | const uint8_t *buf, int size) | ||
| 866 | { | ||
| 867 | int ret; | ||
| 868 | struct socket *so = slirp_find_ctl_socket(slirp, guest_addr, guest_port); | ||
| 869 | |||
| 870 | if (!so) | ||
| 871 | return; | ||
| 872 | |||
| 873 | ret = soreadbuf(so, (const char *)buf, size); | ||
| 874 | |||
| 875 | if (ret > 0) | ||
| 876 | tcp_output(sototcpcb(so)((so)->so_tcpcb)); | ||
| 877 | } | ||
| 878 | |||
| 879 | static void slirp_tcp_save(QEMUFile *f, struct tcpcb *tp) | ||
| 880 | { | ||
| 881 | int i; | ||
| 882 | |||
| 883 | qemu_put_sbe16(f, tp->t_state); | ||
| 884 | for (i = 0; i < TCPT_NTIMERS4; i++) | ||
| 885 | qemu_put_sbe16(f, tp->t_timer[i]); | ||
| 886 | qemu_put_sbe16(f, tp->t_rxtshift); | ||
| 887 | qemu_put_sbe16(f, tp->t_rxtcur); | ||
| 888 | qemu_put_sbe16(f, tp->t_dupacks); | ||
| 889 | qemu_put_be16(f, tp->t_maxseg); | ||
| 890 | qemu_put_sbyteqemu_put_byte(f, tp->t_force); | ||
| 891 | qemu_put_be16(f, tp->t_flags); | ||
| 892 | qemu_put_be32(f, tp->snd_una); | ||
| 893 | qemu_put_be32(f, tp->snd_nxt); | ||
| 894 | qemu_put_be32(f, tp->snd_up); | ||
| 895 | qemu_put_be32(f, tp->snd_wl1); | ||
| 896 | qemu_put_be32(f, tp->snd_wl2); | ||
| 897 | qemu_put_be32(f, tp->iss); | ||
| 898 | qemu_put_be32(f, tp->snd_wnd); | ||
| 899 | qemu_put_be32(f, tp->rcv_wnd); | ||
| 900 | qemu_put_be32(f, tp->rcv_nxt); | ||
| 901 | qemu_put_be32(f, tp->rcv_up); | ||
| 902 | qemu_put_be32(f, tp->irs); | ||
| 903 | qemu_put_be32(f, tp->rcv_adv); | ||
| 904 | qemu_put_be32(f, tp->snd_max); | ||
| 905 | qemu_put_be32(f, tp->snd_cwnd); | ||
| 906 | qemu_put_be32(f, tp->snd_ssthresh); | ||
| 907 | qemu_put_sbe16(f, tp->t_idle); | ||
| 908 | qemu_put_sbe16(f, tp->t_rtt); | ||
| 909 | qemu_put_be32(f, tp->t_rtseq); | ||
| 910 | qemu_put_sbe16(f, tp->t_srtt); | ||
| 911 | qemu_put_sbe16(f, tp->t_rttvar); | ||
| 912 | qemu_put_be16(f, tp->t_rttmin); | ||
| 913 | qemu_put_be32(f, tp->max_sndwnd); | ||
| 914 | qemu_put_byte(f, tp->t_oobflags); | ||
| 915 | qemu_put_byte(f, tp->t_iobc); | ||
| 916 | qemu_put_sbe16(f, tp->t_softerror); | ||
| 917 | qemu_put_byte(f, tp->snd_scale); | ||
| 918 | qemu_put_byte(f, tp->rcv_scale); | ||
| 919 | qemu_put_byte(f, tp->request_r_scale); | ||
| 920 | qemu_put_byte(f, tp->requested_s_scale); | ||
| 921 | qemu_put_be32(f, tp->ts_recent); | ||
| 922 | qemu_put_be32(f, tp->ts_recent_age); | ||
| 923 | qemu_put_be32(f, tp->last_ack_sent); | ||
| 924 | } | ||
| 925 | |||
| 926 | static void slirp_sbuf_save(QEMUFile *f, struct sbuf *sbuf) | ||
| 927 | { | ||
| 928 | uint32_t off; | ||
| 929 | |||
| 930 | qemu_put_be32(f, sbuf->sb_cc); | ||
| 931 | qemu_put_be32(f, sbuf->sb_datalen); | ||
| 932 | off = (uint32_t)(sbuf->sb_wptr - sbuf->sb_data); | ||
| 933 | qemu_put_sbe32(f, off); | ||
| 934 | off = (uint32_t)(sbuf->sb_rptr - sbuf->sb_data); | ||
| 935 | qemu_put_sbe32(f, off); | ||
| 936 | qemu_put_buffer(f, (unsigned char*)sbuf->sb_data, sbuf->sb_datalen); | ||
| 937 | } | ||
| 938 | |||
| 939 | static void slirp_socket_save(QEMUFile *f, struct socket *so) | ||
| 940 | { | ||
| 941 | qemu_put_be32(f, so->so_urgc); | ||
| 942 | qemu_put_be32(f, so->so_faddr.s_addr); | ||
| 943 | qemu_put_be32(f, so->so_laddr.s_addr); | ||
| 944 | qemu_put_be16(f, so->so_fport); | ||
| 945 | qemu_put_be16(f, so->so_lport); | ||
| 946 | qemu_put_byte(f, so->so_iptos); | ||
| 947 | qemu_put_byte(f, so->so_emu); | ||
| 948 | qemu_put_byte(f, so->so_type); | ||
| 949 | qemu_put_be32(f, so->so_state); | ||
| 950 | slirp_sbuf_save(f, &so->so_rcv); | ||
| 951 | slirp_sbuf_save(f, &so->so_snd); | ||
| 952 | slirp_tcp_save(f, so->so_tcpcb); | ||
| 953 | } | ||
| 954 | |||
| 955 | static void slirp_bootp_save(QEMUFile *f, Slirp *slirp) | ||
| 956 | { | ||
| 957 | int i; | ||
| 958 | |||
| 959 | for (i = 0; i < NB_BOOTP_CLIENTS16; i++) { | ||
| 960 | qemu_put_be16(f, slirp->bootp_clients[i].allocated); | ||
| 961 | qemu_put_buffer(f, slirp->bootp_clients[i].macaddr, 6); | ||
| 962 | } | ||
| 963 | } | ||
| 964 | |||
| 965 | static void slirp_state_save(QEMUFile *f, void *opaque) | ||
| 966 | { | ||
| 967 | Slirp *slirp = opaque; | ||
| 968 | struct ex_list *ex_ptr; | ||
| 969 | |||
| 970 | for (ex_ptr = slirp->exec_list; ex_ptr; ex_ptr = ex_ptr->ex_next) | ||
| 971 | if (ex_ptr->ex_pty == 3) { | ||
| 972 | struct socket *so; | ||
| 973 | so = slirp_find_ctl_socket(slirp, ex_ptr->ex_addr, | ||
| 974 | ntohs(ex_ptr->ex_fport)); | ||
| 975 | if (!so) | ||
| 976 | continue; | ||
| 977 | |||
| 978 | qemu_put_byte(f, 42); | ||
| 979 | slirp_socket_save(f, so); | ||
| 980 | } | ||
| 981 | qemu_put_byte(f, 0); | ||
| 982 | |||
| 983 | qemu_put_be16(f, slirp->ip_id); | ||
| 984 | |||
| 985 | slirp_bootp_save(f, slirp); | ||
| 986 | } | ||
| 987 | |||
| 988 | static void slirp_tcp_load(QEMUFile *f, struct tcpcb *tp) | ||
| 989 | { | ||
| 990 | int i; | ||
| 991 | |||
| 992 | tp->t_state = qemu_get_sbe16(f); | ||
| 993 | for (i = 0; i < TCPT_NTIMERS4; i++) | ||
| 994 | tp->t_timer[i] = qemu_get_sbe16(f); | ||
| 995 | tp->t_rxtshift = qemu_get_sbe16(f); | ||
| 996 | tp->t_rxtcur = qemu_get_sbe16(f); | ||
| 997 | tp->t_dupacks = qemu_get_sbe16(f); | ||
| 998 | tp->t_maxseg = qemu_get_be16(f); | ||
| 999 | tp->t_force = qemu_get_sbyteqemu_get_byte(f); | ||
| 1000 | tp->t_flags = qemu_get_be16(f); | ||
| 1001 | tp->snd_una = qemu_get_be32(f); | ||
| 1002 | tp->snd_nxt = qemu_get_be32(f); | ||
| 1003 | tp->snd_up = qemu_get_be32(f); | ||
| 1004 | tp->snd_wl1 = qemu_get_be32(f); | ||
| 1005 | tp->snd_wl2 = qemu_get_be32(f); | ||
| 1006 | tp->iss = qemu_get_be32(f); | ||
| 1007 | tp->snd_wnd = qemu_get_be32(f); | ||
| 1008 | tp->rcv_wnd = qemu_get_be32(f); | ||
| 1009 | tp->rcv_nxt = qemu_get_be32(f); | ||
| 1010 | tp->rcv_up = qemu_get_be32(f); | ||
| 1011 | tp->irs = qemu_get_be32(f); | ||
| 1012 | tp->rcv_adv = qemu_get_be32(f); | ||
| 1013 | tp->snd_max = qemu_get_be32(f); | ||
| 1014 | tp->snd_cwnd = qemu_get_be32(f); | ||
| 1015 | tp->snd_ssthresh = qemu_get_be32(f); | ||
| 1016 | tp->t_idle = qemu_get_sbe16(f); | ||
| 1017 | tp->t_rtt = qemu_get_sbe16(f); | ||
| 1018 | tp->t_rtseq = qemu_get_be32(f); | ||
| 1019 | tp->t_srtt = qemu_get_sbe16(f); | ||
| 1020 | tp->t_rttvar = qemu_get_sbe16(f); | ||
| 1021 | tp->t_rttmin = qemu_get_be16(f); | ||
| 1022 | tp->max_sndwnd = qemu_get_be32(f); | ||
| 1023 | tp->t_oobflags = qemu_get_byte(f); | ||
| 1024 | tp->t_iobc = qemu_get_byte(f); | ||
| 1025 | tp->t_softerror = qemu_get_sbe16(f); | ||
| 1026 | tp->snd_scale = qemu_get_byte(f); | ||
| 1027 | tp->rcv_scale = qemu_get_byte(f); | ||
| 1028 | tp->request_r_scale = qemu_get_byte(f); | ||
| 1029 | tp->requested_s_scale = qemu_get_byte(f); | ||
| 1030 | tp->ts_recent = qemu_get_be32(f); | ||
| 1031 | tp->ts_recent_age = qemu_get_be32(f); | ||
| 1032 | tp->last_ack_sent = qemu_get_be32(f); | ||
| 1033 | tcp_template(tp); | ||
| 1034 | } | ||
| 1035 | |||
| 1036 | static int slirp_sbuf_load(QEMUFile *f, struct sbuf *sbuf) | ||
| 1037 | { | ||
| 1038 | uint32_t off, sb_cc, sb_datalen; | ||
| 1039 | |||
| 1040 | sb_cc = qemu_get_be32(f); | ||
| 1041 | sb_datalen = qemu_get_be32(f); | ||
| 1042 | |||
| 1043 | sbreserve(sbuf, sb_datalen); | ||
| 1044 | |||
| 1045 | if (sbuf->sb_datalen != sb_datalen) | ||
| 1046 | return -ENOMEM12; | ||
| 1047 | |||
| 1048 | sbuf->sb_cc = sb_cc; | ||
| 1049 | |||
| 1050 | off = qemu_get_sbe32(f); | ||
| 1051 | sbuf->sb_wptr = sbuf->sb_data + off; | ||
| 1052 | off = qemu_get_sbe32(f); | ||
| 1053 | sbuf->sb_rptr = sbuf->sb_data + off; | ||
| 1054 | qemu_get_buffer(f, (unsigned char*)sbuf->sb_data, sbuf->sb_datalen); | ||
| 1055 | |||
| 1056 | return 0; | ||
| 1057 | } | ||
| 1058 | |||
| 1059 | static int slirp_socket_load(QEMUFile *f, struct socket *so) | ||
| 1060 | { | ||
| 1061 | if (tcp_attach(so) < 0) | ||
| 1062 | return -ENOMEM12; | ||
| 1063 | |||
| 1064 | so->so_urgc = qemu_get_be32(f); | ||
| 1065 | so->so_faddr.s_addr = qemu_get_be32(f); | ||
| 1066 | so->so_laddr.s_addr = qemu_get_be32(f); | ||
| 1067 | so->so_fport = qemu_get_be16(f); | ||
| 1068 | so->so_lport = qemu_get_be16(f); | ||
| 1069 | so->so_iptos = qemu_get_byte(f); | ||
| 1070 | so->so_emu = qemu_get_byte(f); | ||
| 1071 | so->so_type = qemu_get_byte(f); | ||
| 1072 | so->so_state = qemu_get_be32(f); | ||
| 1073 | if (slirp_sbuf_load(f, &so->so_rcv) < 0) | ||
| 1074 | return -ENOMEM12; | ||
| 1075 | if (slirp_sbuf_load(f, &so->so_snd) < 0) | ||
| 1076 | return -ENOMEM12; | ||
| 1077 | slirp_tcp_load(f, so->so_tcpcb); | ||
| 1078 | |||
| 1079 | return 0; | ||
| 1080 | } | ||
| 1081 | |||
| 1082 | static void slirp_bootp_load(QEMUFile *f, Slirp *slirp) | ||
| 1083 | { | ||
| 1084 | int i; | ||
| 1085 | |||
| 1086 | for (i = 0; i < NB_BOOTP_CLIENTS16; i++) { | ||
| 1087 | slirp->bootp_clients[i].allocated = qemu_get_be16(f); | ||
| 1088 | qemu_get_buffer(f, slirp->bootp_clients[i].macaddr, 6); | ||
| 1089 | } | ||
| 1090 | } | ||
| 1091 | |||
| 1092 | static int slirp_state_load(QEMUFile *f, void *opaque, int version_id) | ||
| 1093 | { | ||
| 1094 | Slirp *slirp = opaque; | ||
| 1095 | struct ex_list *ex_ptr; | ||
| 1096 | |||
| 1097 | while (qemu_get_byte(f)) { | ||
| 1098 | int ret; | ||
| 1099 | struct socket *so = socreate(slirp); | ||
| 1100 | |||
| 1101 | if (!so) | ||
| 1102 | return -ENOMEM12; | ||
| 1103 | |||
| 1104 | ret = slirp_socket_load(f, so); | ||
| 1105 | |||
| 1106 | if (ret < 0) | ||
| 1107 | return ret; | ||
| 1108 | |||
| 1109 | if ((so->so_faddr.s_addr & slirp->vnetwork_mask.s_addr) != | ||
| 1110 | slirp->vnetwork_addr.s_addr) { | ||
| 1111 | return -EINVAL22; | ||
| 1112 | } | ||
| 1113 | for (ex_ptr = slirp->exec_list; ex_ptr; ex_ptr = ex_ptr->ex_next) { | ||
| 1114 | if (ex_ptr->ex_pty == 3 && | ||
| 1115 | so->so_faddr.s_addr == ex_ptr->ex_addr.s_addr && | ||
| 1116 | so->so_fport == ex_ptr->ex_fport) { | ||
| 1117 | break; | ||
| 1118 | } | ||
| 1119 | } | ||
| 1120 | if (!ex_ptr) | ||
| 1121 | return -EINVAL22; | ||
| 1122 | |||
| 1123 | so->extra = (void *)ex_ptr->ex_exec; | ||
| 1124 | } | ||
| 1125 | |||
| 1126 | if (version_id >= 2) { | ||
| 1127 | slirp->ip_id = qemu_get_be16(f); | ||
| 1128 | } | ||
| 1129 | |||
| 1130 | if (version_id >= 3) { | ||
| 1131 | slirp_bootp_load(f, slirp); | ||
| 1132 | } | ||
| 1133 | |||
| 1134 | return 0; | ||
| 1135 | } |