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