VirtualBox

source: vbox/trunk/src/VBox/Devices/Network/slirp/slirp.c@ 28434

Last change on this file since 28434 was 28434, checked in by vboxsync, 15 years ago

*: whitespace cleanups by scm and two manually picked nits.
  • Property svn:eol-style set to native
File size: 62.8 KB
Line 
1#include "slirp.h"
2#ifdef RT_OS_OS2
3# include <paths.h>
4#endif
5
6#include <VBox/err.h>
7#include <VBox/pdmdrv.h>
8#include <iprt/assert.h>
9#include <iprt/file.h>
10#ifndef RT_OS_WINDOWS
11# include <sys/ioctl.h>
12# include <poll.h>
13#else
14# include <Winnls.h>
15# define _WINSOCK2API_
16# include <IPHlpApi.h>
17#endif
18#include <alias.h>
19
20#ifndef RT_OS_WINDOWS
21
22# define DO_ENGAGE_EVENT1(so, fdset, label) \
23 do { \
24 if ( so->so_poll_index != -1 \
25 && so->s == polls[so->so_poll_index].fd) \
26 { \
27 polls[so->so_poll_index].events |= N_(fdset ## _poll); \
28 break; \
29 } \
30 AssertRelease(poll_index < (nfds)); \
31 AssertRelease(poll_index >= 0 && poll_index < (nfds)); \
32 polls[poll_index].fd = (so)->s; \
33 (so)->so_poll_index = poll_index; \
34 polls[poll_index].events = N_(fdset ## _poll); \
35 polls[poll_index].revents = 0; \
36 poll_index++; \
37 } while (0)
38
39# define DO_ENGAGE_EVENT2(so, fdset1, fdset2, label) \
40 do { \
41 if ( so->so_poll_index != -1 \
42 && so->s == polls[so->so_poll_index].fd) \
43 { \
44 polls[so->so_poll_index].events |= \
45 N_(fdset1 ## _poll) | N_(fdset2 ## _poll); \
46 break; \
47 } \
48 AssertRelease(poll_index < (nfds)); \
49 polls[poll_index].fd = (so)->s; \
50 (so)->so_poll_index = poll_index; \
51 polls[poll_index].events = \
52 N_(fdset1 ## _poll) | N_(fdset2 ## _poll); \
53 poll_index++; \
54 } while (0)
55
56# define DO_POLL_EVENTS(rc, error, so, events, label) do {} while (0)
57
58/*
59 * DO_CHECK_FD_SET is used in dumping events on socket, including POLLNVAL.
60 * gcc warns about attempts to log POLLNVAL so construction in a last to lines
61 * used to catch POLLNVAL while logging and return false in case of error while
62 * normal usage.
63 */
64# define DO_CHECK_FD_SET(so, events, fdset) \
65 ( ((so)->so_poll_index != -1) \
66 && ((so)->so_poll_index <= ndfs) \
67 && ((so)->s == polls[so->so_poll_index].fd) \
68 && (polls[(so)->so_poll_index].revents & N_(fdset ## _poll)) \
69 && ( N_(fdset ## _poll) == POLLNVAL \
70 || !(polls[(so)->so_poll_index].revents & POLLNVAL)))
71
72 /* specific for Unix API */
73# define DO_UNIX_CHECK_FD_SET(so, events, fdset) DO_CHECK_FD_SET((so), (events), fdset)
74 /* specific for Windows Winsock API */
75# define DO_WIN_CHECK_FD_SET(so, events, fdset) 0
76
77# ifndef RT_OS_LINUX
78# define readfds_poll (POLLRDNORM)
79# define writefds_poll (POLLWRNORM)
80# else
81# define readfds_poll (POLLIN)
82# define writefds_poll (POLLOUT)
83# endif
84# define xfds_poll (POLLPRI)
85# define closefds_poll (POLLHUP)
86# define rderr_poll (POLLERR)
87# define rdhup_poll (POLLHUP)
88# define nval_poll (POLLNVAL)
89
90# define ICMP_ENGAGE_EVENT(so, fdset) \
91 do { \
92 if (pData->icmp_socket.s != -1) \
93 DO_ENGAGE_EVENT1((so), fdset, ICMP); \
94 } while (0)
95
96#else /* RT_OS_WINDOWS */
97
98/*
99 * On Windows, we will be notified by IcmpSendEcho2() when the response arrives.
100 * So no call to WSAEventSelect necessary.
101 */
102# define ICMP_ENGAGE_EVENT(so, fdset) do {} while (0)
103
104/*
105 * On Windows we use FD_ALL_EVENTS to ensure that we don't miss any event.
106 */
107# define DO_ENGAGE_EVENT1(so, fdset1, label) \
108 do { \
109 rc = WSAEventSelect((so)->s, VBOX_SOCKET_EVENT, FD_ALL_EVENTS); \
110 if (rc == SOCKET_ERROR) \
111 { \
112 /* This should not happen */ \
113 error = WSAGetLastError(); \
114 LogRel(("WSAEventSelect (" #label ") error %d (so=%x, socket=%s, event=%x)\n", \
115 error, (so), (so)->s, VBOX_SOCKET_EVENT)); \
116 } \
117 } while (0); \
118 CONTINUE(label)
119
120# define DO_ENGAGE_EVENT2(so, fdset1, fdset2, label) \
121 DO_ENGAGE_EVENT1((so), (fdset1), label)
122
123# define DO_POLL_EVENTS(rc, error, so, events, label) \
124 (rc) = WSAEnumNetworkEvents((so)->s, VBOX_SOCKET_EVENT, (events)); \
125 if ((rc) == SOCKET_ERROR) \
126 { \
127 (error) = WSAGetLastError(); \
128 LogRel(("WSAEnumNetworkEvents " #label " error %d\n", (error))); \
129 CONTINUE(label); \
130 }
131
132# define acceptds_win FD_ACCEPT
133# define acceptds_win_bit FD_ACCEPT_BIT
134# define readfds_win FD_READ
135# define readfds_win_bit FD_READ_BIT
136# define writefds_win FD_WRITE
137# define writefds_win_bit FD_WRITE_BIT
138# define xfds_win FD_OOB
139# define xfds_win_bit FD_OOB_BIT
140# define closefds_win FD_CLOSE
141# define closefds_win_bit FD_CLOSE_BIT
142
143# define closefds_win FD_CLOSE
144# define closefds_win_bit FD_CLOSE_BIT
145
146# define DO_CHECK_FD_SET(so, events, fdset) \
147 (((events).lNetworkEvents & fdset ## _win) && ((events).iErrorCode[fdset ## _win_bit] == 0))
148
149# define DO_WIN_CHECK_FD_SET(so, events, fdset) DO_CHECK_FD_SET((so), (events), fdset)
150# define DO_UNIX_CHECK_FD_SET(so, events, fdset) 1 /*specific for Unix API */
151
152#endif /* RT_OS_WINDOWS */
153
154#define TCP_ENGAGE_EVENT1(so, fdset) \
155 DO_ENGAGE_EVENT1((so), fdset, tcp)
156
157#define TCP_ENGAGE_EVENT2(so, fdset1, fdset2) \
158 DO_ENGAGE_EVENT2((so), fdset1, fdset2, tcp)
159
160#define UDP_ENGAGE_EVENT(so, fdset) \
161 DO_ENGAGE_EVENT1((so), fdset, udp)
162
163#define POLL_TCP_EVENTS(rc, error, so, events) \
164 DO_POLL_EVENTS((rc), (error), (so), (events), tcp)
165
166#define POLL_UDP_EVENTS(rc, error, so, events) \
167 DO_POLL_EVENTS((rc), (error), (so), (events), udp)
168
169#define CHECK_FD_SET(so, events, set) \
170 (DO_CHECK_FD_SET((so), (events), set))
171
172#define WIN_CHECK_FD_SET(so, events, set) \
173 (DO_WIN_CHECK_FD_SET((so), (events), set))
174
175#define UNIX_CHECK_FD_SET(so, events, set) \
176 (DO_UNIX_CHECK_FD_SET(so, events, set))
177
178/*
179 * Loging macros
180 */
181#if VBOX_WITH_DEBUG_NAT_SOCKETS
182# if defined(RT_OS_WINDOWS)
183# define DO_LOG_NAT_SOCK(so, proto, winevent, r_fdset, w_fdset, x_fdset) \
184 do { \
185 LogRel((" " #proto " %R[natsock] %R[natwinnetevents]\n", (so), (winevent))); \
186 } while (0)
187# else /* !RT_OS_WINDOWS */
188# define DO_LOG_NAT_SOCK(so, proto, winevent, r_fdset, w_fdset, x_fdset) \
189 do { \
190 LogRel((" " #proto " %R[natsock] %s %s %s er: %s, %s, %s\n", (so), \
191 CHECK_FD_SET(so, ign ,r_fdset) ? "READ":"", \
192 CHECK_FD_SET(so, ign, w_fdset) ? "WRITE":"", \
193 CHECK_FD_SET(so, ign, x_fdset) ? "OOB":"", \
194 CHECK_FD_SET(so, ign, rderr) ? "RDERR":"", \
195 CHECK_FD_SET(so, ign, rdhup) ? "RDHUP":"", \
196 CHECK_FD_SET(so, ign, nval) ? "RDNVAL":"")); \
197 } while (0)
198# endif /* !RT_OS_WINDOWS */
199#else /* !VBOX_WITH_DEBUG_NAT_SOCKETS */
200# define DO_LOG_NAT_SOCK(so, proto, winevent, r_fdset, w_fdset, x_fdset) do {} while (0)
201#endif /* !VBOX_WITH_DEBUG_NAT_SOCKETS */
202
203#define LOG_NAT_SOCK(so, proto, winevent, r_fdset, w_fdset, x_fdset) \
204 DO_LOG_NAT_SOCK((so), proto, (winevent), r_fdset, w_fdset, x_fdset)
205
206static void activate_port_forwarding(PNATState, const uint8_t *pEther);
207
208static const uint8_t special_ethaddr[6] =
209{
210 0x52, 0x54, 0x00, 0x12, 0x35, 0x00
211};
212
213static const uint8_t broadcast_ethaddr[6] =
214{
215 0xff, 0xff, 0xff, 0xff, 0xff, 0xff
216};
217
218const uint8_t zerro_ethaddr[6] =
219{
220 0x0, 0x0, 0x0, 0x0, 0x0, 0x0
221};
222
223#ifdef RT_OS_WINDOWS
224static int get_dns_addr_domain(PNATState pData, bool fVerbose,
225 struct in_addr *pdns_addr,
226 const char **ppszDomain)
227{
228 ULONG flags = GAA_FLAG_INCLUDE_PREFIX; /*GAA_FLAG_INCLUDE_ALL_INTERFACES;*/ /* all interfaces registered in NDIS */
229 PIP_ADAPTER_ADDRESSES pAdapterAddr = NULL;
230 PIP_ADAPTER_ADDRESSES pAddr = NULL;
231 PIP_ADAPTER_DNS_SERVER_ADDRESS pDnsAddr = NULL;
232 ULONG size;
233 int wlen = 0;
234 char *pszSuffix;
235 struct dns_domain_entry *pDomain = NULL;
236 ULONG ret = ERROR_SUCCESS;
237
238 /* @todo add SKIPing flags to get only required information */
239
240 /* determine size of buffer */
241 size = 0;
242 ret = pData->pfGetAdaptersAddresses(AF_INET, 0, NULL /* reserved */, pAdapterAddr, &size);
243 if (ret != ERROR_BUFFER_OVERFLOW)
244 {
245 LogRel(("NAT: error %lu occurred on capacity detection operation\n", ret));
246 return -1;
247 }
248 if (size == 0)
249 {
250 LogRel(("NAT: Win socket API returns non capacity\n"));
251 return -1;
252 }
253
254 pAdapterAddr = RTMemAllocZ(size);
255 if (!pAdapterAddr)
256 {
257 LogRel(("NAT: No memory available \n"));
258 return -1;
259 }
260 ret = pData->pfGetAdaptersAddresses(AF_INET, 0, NULL /* reserved */, pAdapterAddr, &size);
261 if (ret != ERROR_SUCCESS)
262 {
263 LogRel(("NAT: error %lu occurred on fetching adapters info\n", ret));
264 RTMemFree(pAdapterAddr);
265 return -1;
266 }
267
268 for (pAddr = pAdapterAddr; pAddr != NULL; pAddr = pAddr->Next)
269 {
270 int found;
271 if (pAddr->OperStatus != IfOperStatusUp)
272 continue;
273
274 for (pDnsAddr = pAddr->FirstDnsServerAddress; pDnsAddr != NULL; pDnsAddr = pDnsAddr->Next)
275 {
276 struct sockaddr *SockAddr = pDnsAddr->Address.lpSockaddr;
277 struct in_addr InAddr;
278 struct dns_entry *pDns;
279
280 if (SockAddr->sa_family != AF_INET)
281 continue;
282
283 InAddr = ((struct sockaddr_in *)SockAddr)->sin_addr;
284
285 /* add dns server to list */
286 pDns = RTMemAllocZ(sizeof(struct dns_entry));
287 if (!pDns)
288 {
289 LogRel(("NAT: Can't allocate buffer for DNS entry\n"));
290 RTMemFree(pAdapterAddr);
291 return VERR_NO_MEMORY;
292 }
293
294 LogRel(("NAT: adding %R[IP4] to DNS server list\n", &InAddr));
295 if ((InAddr.s_addr & RT_H2N_U32_C(IN_CLASSA_NET)) == RT_N2H_U32_C(INADDR_LOOPBACK & IN_CLASSA_NET))
296 pDns->de_addr.s_addr = RT_H2N_U32(RT_N2H_U32(pData->special_addr.s_addr) | CTL_ALIAS);
297 else
298 pDns->de_addr.s_addr = InAddr.s_addr;
299
300 TAILQ_INSERT_HEAD(&pData->pDnsList, pDns, de_list);
301
302 if (pAddr->DnsSuffix == NULL)
303 continue;
304
305 /* uniq */
306 RTUtf16ToUtf8(pAddr->DnsSuffix, &pszSuffix);
307 if (!pszSuffix || strlen(pszSuffix) == 0)
308 {
309 RTStrFree(pszSuffix);
310 continue;
311 }
312
313 found = 0;
314 LIST_FOREACH(pDomain, &pData->pDomainList, dd_list)
315 {
316 if ( pDomain->dd_pszDomain != NULL
317 && strcmp(pDomain->dd_pszDomain, pszSuffix) == 0)
318 {
319 found = 1;
320 RTStrFree(pszSuffix);
321 break;
322 }
323 }
324 if (!found)
325 {
326 pDomain = RTMemAllocZ(sizeof(struct dns_domain_entry));
327 if (!pDomain)
328 {
329 LogRel(("NAT: not enough memory\n"));
330 RTStrFree(pszSuffix);
331 RTMemFree(pAdapterAddr);
332 return VERR_NO_MEMORY;
333 }
334 pDomain->dd_pszDomain = pszSuffix;
335 LogRel(("NAT: adding domain name %s to search list\n", pDomain->dd_pszDomain));
336 LIST_INSERT_HEAD(&pData->pDomainList, pDomain, dd_list);
337 }
338 }
339 }
340 RTMemFree(pAdapterAddr);
341 return 0;
342}
343
344#else /* !RT_OS_WINDOWS */
345
346static int RTFileGets(RTFILE File, void *pvBuf, size_t cbBufSize, size_t *pcbRead)
347{
348 size_t cbRead;
349 char bTest;
350 int rc = VERR_NO_MEMORY;
351 char *pu8Buf = (char *)pvBuf;
352 *pcbRead = 0;
353
354 while ( RT_SUCCESS(rc = RTFileRead(File, &bTest, 1, &cbRead))
355 && (pu8Buf - (char *)pvBuf) < cbBufSize)
356 {
357 if (cbRead == 0)
358 return VERR_EOF;
359
360 if (bTest == '\r' || bTest == '\n')
361 {
362 *pu8Buf = 0;
363 return VINF_SUCCESS;
364 }
365 *pu8Buf = bTest;
366 pu8Buf++;
367 (*pcbRead)++;
368 }
369 return rc;
370}
371
372static int get_dns_addr_domain(PNATState pData, bool fVerbose,
373 struct in_addr *pdns_addr,
374 const char **ppszDomain)
375{
376 char buff[512];
377 char buff2[256];
378 RTFILE f;
379 int fFoundNameserver = 0;
380 struct in_addr tmp_addr;
381 int rc;
382 size_t bytes;
383
384# ifdef RT_OS_OS2
385 /* Try various locations. */
386 char *etc = getenv("ETC");
387 if (etc)
388 {
389 RTStrmPrintf(buff, sizeof(buff), "%s/RESOLV2", etc);
390 rc = RTFileOpen(&f, buff, RTFILE_O_READ | RTFILE_O_OPEN | RTFILE_O_DENY_NONE);
391 }
392 if (RT_FAILURE(rc))
393 {
394 RTStrmPrintf(buff, sizeof(buff), "%s/RESOLV2", _PATH_ETC);
395 rc = RTFileOpen(&f, buff, RTFILE_O_READ | RTFILE_O_OPEN | RTFILE_O_DENY_NONE);
396 }
397 if (RT_FAILURE(rc))
398 {
399 RTStrmPrintf(buff, sizeof(buff), "%s/resolv.conf", _PATH_ETC);
400 rc = RTFileOpen(&f, buff, RTFILE_O_READ | RTFILE_O_OPEN | RTFILE_O_DENY_NONE);
401 }
402# else /* !RT_OS_OS2 */
403# ifndef DEBUG_vvl
404 rc = RTFileOpen(&f, "/etc/resolv.conf", RTFILE_O_READ | RTFILE_O_OPEN | RTFILE_O_DENY_NONE);
405# else
406 char *home = getenv("HOME");
407 RTStrPrintf(buff, sizeof(buff), "%s/resolv.conf", home);
408 rc = RTFileOpen(&f, buff, RTFILE_O_READ | RTFILE_O_OPEN | RTFILE_O_DENY_NONE);
409 if (RT_SUCCESS(rc))
410 {
411 Log(("NAT: DNS we're using %s\n", buff));
412 }
413 else
414 {
415 rc = RTFileOpen(&f, "/etc/resolv.conf", RTFILE_O_READ | RTFILE_O_OPEN | RTFILE_O_DENY_NONE);
416 Log(("NAT: DNS we're using %s\n", buff));
417 }
418# endif
419# endif /* !RT_OS_OS2 */
420 if (RT_FAILURE(rc))
421 return -1;
422
423 if (ppszDomain)
424 *ppszDomain = NULL;
425
426 Log(("NAT: DNS Servers:\n"));
427 while ( RT_SUCCESS(rc = RTFileGets(f, buff, 512, &bytes))
428 && rc != VERR_EOF)
429 {
430 struct dns_entry *pDns = NULL;
431 if (sscanf(buff, "nameserver%*[ \t]%256s", buff2) == 1)
432 {
433 if (!inet_aton(buff2, &tmp_addr))
434 continue;
435
436 /* localhost mask */
437 pDns = RTMemAllocZ(sizeof (struct dns_entry));
438 if (!pDns)
439 {
440 LogRel(("can't alloc memory for DNS entry\n"));
441 return -1;
442 }
443
444 /* check */
445 pDns->de_addr.s_addr = tmp_addr.s_addr;
446 if ((pDns->de_addr.s_addr & RT_H2N_U32_C(IN_CLASSA_NET)) == RT_N2H_U32_C(INADDR_LOOPBACK & IN_CLASSA_NET))
447 {
448 pDns->de_addr.s_addr = RT_H2N_U32(RT_N2H_U32(pData->special_addr.s_addr) | CTL_ALIAS);
449 }
450 TAILQ_INSERT_HEAD(&pData->pDnsList, pDns, de_list);
451 fFoundNameserver++;
452 }
453 if ((!strncmp(buff, "domain", 6) || !strncmp(buff, "search", 6)))
454 {
455 char *tok;
456 char *saveptr;
457 struct dns_domain_entry *pDomain = NULL;
458 int fFoundDomain = 0;
459 tok = strtok_r(&buff[6], " \t\n", &saveptr);
460 LIST_FOREACH(pDomain, &pData->pDomainList, dd_list)
461 {
462 if ( tok != NULL
463 && strcmp(tok, pDomain->dd_pszDomain) == 0)
464 {
465 fFoundDomain = 1;
466 break;
467 }
468 }
469 if (tok != NULL && !fFoundDomain)
470 {
471 pDomain = RTMemAllocZ(sizeof(struct dns_domain_entry));
472 if (!pDomain)
473 {
474 LogRel(("NAT: not enought memory to add domain list\n"));
475 return VERR_NO_MEMORY;
476 }
477 pDomain->dd_pszDomain = RTStrDup(tok);
478 LogRel(("NAT: adding domain name %s to search list\n", pDomain->dd_pszDomain));
479 LIST_INSERT_HEAD(&pData->pDomainList, pDomain, dd_list);
480 }
481 }
482 }
483 RTFileClose(f);
484 if (!fFoundNameserver)
485 return -1;
486 return 0;
487}
488
489#endif /* !RT_OS_WINDOWS */
490
491static int slirp_init_dns_list(PNATState pData)
492{
493 TAILQ_INIT(&pData->pDnsList);
494 LIST_INIT(&pData->pDomainList);
495 return get_dns_addr_domain(pData, true, NULL, NULL);
496}
497
498static void slirp_release_dns_list(PNATState pData)
499{
500 struct dns_entry *pDns = NULL;
501 struct dns_domain_entry *pDomain = NULL;
502
503 while (!TAILQ_EMPTY(&pData->pDnsList))
504 {
505 pDns = TAILQ_FIRST(&pData->pDnsList);
506 TAILQ_REMOVE(&pData->pDnsList, pDns, de_list);
507 RTMemFree(pDns);
508 }
509
510 while (!LIST_EMPTY(&pData->pDomainList))
511 {
512 pDomain = LIST_FIRST(&pData->pDomainList);
513 LIST_REMOVE(pDomain, dd_list);
514 if (pDomain->dd_pszDomain != NULL)
515 RTStrFree(pDomain->dd_pszDomain);
516 RTMemFree(pDomain);
517 }
518}
519
520int get_dns_addr(PNATState pData, struct in_addr *pdns_addr)
521{
522 return get_dns_addr_domain(pData, false, pdns_addr, NULL);
523}
524
525int slirp_init(PNATState *ppData, uint32_t u32NetAddr, uint32_t u32Netmask,
526 bool fPassDomain, bool fUseHostResolver, void *pvUser)
527{
528 int fNATfailed = 0;
529 int rc;
530 PNATState pData = RTMemAllocZ(sizeof(NATState));
531 *ppData = pData;
532 if (!pData)
533 return VERR_NO_MEMORY;
534 if (u32Netmask & 0x1f)
535 /* CTL is x.x.x.15, bootp passes up to 16 IPs (15..31) */
536 return VERR_INVALID_PARAMETER;
537 pData->fPassDomain = !fUseHostResolver ? fPassDomain : false;
538 pData->fUseHostResolver = fUseHostResolver;
539 pData->pvUser = pvUser;
540 pData->netmask = u32Netmask;
541
542 /* sockets & TCP defaults */
543 pData->socket_rcv = 64 * _1K;
544 pData->socket_snd = 64 * _1K;
545 tcp_sndspace = 64 * _1K;
546 tcp_rcvspace = 64 * _1K;
547
548#ifdef RT_OS_WINDOWS
549 {
550 WSADATA Data;
551 WSAStartup(MAKEWORD(2, 0), &Data);
552 }
553 pData->phEvents[VBOX_SOCKET_EVENT_INDEX] = CreateEvent(NULL, FALSE, FALSE, NULL);
554#endif
555#ifdef VBOX_WITH_SLIRP_MT
556 QSOCKET_LOCK_CREATE(tcb);
557 QSOCKET_LOCK_CREATE(udb);
558 rc = RTReqCreateQueue(&pData->pReqQueue);
559 AssertReleaseRC(rc);
560#endif
561
562 link_up = 1;
563
564 rc = bootp_dhcp_init(pData);
565 if (rc != 0)
566 {
567 LogRel(("NAT: DHCP server initialization was failed\n"));
568 return VINF_NAT_DNS;
569 }
570 debug_init();
571 if_init(pData);
572 ip_init(pData);
573 icmp_init(pData);
574
575 /* Initialise mbufs *after* setting the MTU */
576#ifndef VBOX_WITH_SLIRP_BSD_MBUF
577 m_init(pData);
578#else
579 mbuf_init(pData);
580#endif
581
582 pData->special_addr.s_addr = u32NetAddr;
583 pData->slirp_ethaddr = &special_ethaddr[0];
584 alias_addr.s_addr = pData->special_addr.s_addr | RT_H2N_U32_C(CTL_ALIAS);
585 /* @todo: add ability to configure this staff */
586
587 /* set default addresses */
588 inet_aton("127.0.0.1", &loopback_addr);
589 if (!pData->fUseHostResolver)
590 {
591 if (slirp_init_dns_list(pData) < 0)
592 fNATfailed = 1;
593
594 dnsproxy_init(pData);
595 }
596
597 getouraddr(pData);
598 {
599 int flags = 0;
600 struct in_addr proxy_addr;
601 pData->proxy_alias = LibAliasInit(pData, NULL);
602 if (pData->proxy_alias == NULL)
603 {
604 LogRel(("NAT: LibAlias default rule wasn't initialized\n"));
605 AssertMsgFailed(("NAT: LibAlias default rule wasn't initialized\n"));
606 }
607 flags = LibAliasSetMode(pData->proxy_alias, 0, 0);
608#ifndef NO_FW_PUNCH
609 flags |= PKT_ALIAS_PUNCH_FW;
610#endif
611 flags |= PKT_ALIAS_PROXY_ONLY; /* do transparent proxying */
612 flags |= PKT_ALIAS_LOG; /* set logging */
613 flags = LibAliasSetMode(pData->proxy_alias, flags, ~0);
614 proxy_addr.s_addr = RT_H2N_U32(RT_N2H_U32(pData->special_addr.s_addr) | CTL_ALIAS);
615 LibAliasSetAddress(pData->proxy_alias, proxy_addr);
616 ftp_alias_load(pData);
617 nbt_alias_load(pData);
618 if (pData->fUseHostResolver)
619 dns_alias_load(pData);
620 }
621 return fNATfailed ? VINF_NAT_DNS : VINF_SUCCESS;
622}
623
624/**
625 * Register statistics.
626 */
627void slirp_register_statistics(PNATState pData, PPDMDRVINS pDrvIns)
628{
629#ifdef VBOX_WITH_STATISTICS
630# define PROFILE_COUNTER(name, dsc) REGISTER_COUNTER(name, pData, STAMTYPE_PROFILE, STAMUNIT_TICKS_PER_CALL, dsc)
631# define COUNTING_COUNTER(name, dsc) REGISTER_COUNTER(name, pData, STAMTYPE_COUNTER, STAMUNIT_COUNT, dsc)
632# include "counters.h"
633# undef COUNTER
634/** @todo register statistics for the variables dumped by:
635 * ipstats(pData); tcpstats(pData); udpstats(pData); icmpstats(pData);
636 * mbufstats(pData); sockstats(pData); */
637#endif /* VBOX_WITH_STATISTICS */
638}
639
640/**
641 * Deregister statistics.
642 */
643void slirp_deregister_statistics(PNATState pData, PPDMDRVINS pDrvIns)
644{
645 if (pData == NULL)
646 return;
647#ifdef VBOX_WITH_STATISTICS
648# define PROFILE_COUNTER(name, dsc) DEREGISTER_COUNTER(name, pData)
649# define COUNTING_COUNTER(name, dsc) DEREGISTER_COUNTER(name, pData)
650# include "counters.h"
651#endif /* VBOX_WITH_STATISTICS */
652}
653
654/**
655 * Marks the link as up, making it possible to establish new connections.
656 */
657void slirp_link_up(PNATState pData)
658{
659 struct arp_cache_entry *ac;
660 link_up = 1;
661
662 if (LIST_EMPTY(&pData->arp_cache))
663 return;
664
665 LIST_FOREACH(ac, &pData->arp_cache, list)
666 {
667 activate_port_forwarding(pData, ac->ether);
668 }
669}
670
671/**
672 * Marks the link as down and cleans up the current connections.
673 */
674void slirp_link_down(PNATState pData)
675{
676 struct socket *so;
677 struct port_forward_rule *rule;
678
679 while ((so = tcb.so_next) != &tcb)
680 {
681 if (so->so_state & SS_NOFDREF || so->s == -1)
682 sofree(pData, so);
683 else
684 tcp_drop(pData, sototcpcb(so), 0);
685 }
686
687 while ((so = udb.so_next) != &udb)
688 udp_detach(pData, so);
689
690 /*
691 * Clear the active state of port-forwarding rules to force
692 * re-setup on restoration of communications.
693 */
694 LIST_FOREACH(rule, &pData->port_forward_rule_head, list)
695 {
696 rule->activated = 0;
697 }
698 pData->cRedirectionsActive = 0;
699
700 link_up = 0;
701}
702
703/**
704 * Terminates the slirp component.
705 */
706void slirp_term(PNATState pData)
707{
708 if (pData == NULL)
709 return;
710#ifdef RT_OS_WINDOWS
711 pData->pfIcmpCloseHandle(pData->icmp_socket.sh);
712 FreeLibrary(pData->hmIcmpLibrary);
713 RTMemFree(pData->pvIcmpBuffer);
714#else
715 closesocket(pData->icmp_socket.s);
716#endif
717
718 slirp_link_down(pData);
719 slirp_release_dns_list(pData);
720 ftp_alias_unload(pData);
721 nbt_alias_unload(pData);
722 if (pData->fUseHostResolver)
723 dns_alias_unload(pData);
724 while (!LIST_EMPTY(&instancehead))
725 {
726 struct libalias *la = LIST_FIRST(&instancehead);
727 /* libalias do all clean up */
728 LibAliasUninit(la);
729 }
730 while (!LIST_EMPTY(&pData->arp_cache))
731 {
732 struct arp_cache_entry *ac = LIST_FIRST(&pData->arp_cache);
733 LIST_REMOVE(ac, list);
734 RTMemFree(ac);
735 }
736 bootp_dhcp_fini(pData);
737 m_fini(pData);
738#ifdef RT_OS_WINDOWS
739 WSACleanup();
740#endif
741#ifdef LOG_ENABLED
742 Log(("\n"
743 "NAT statistics\n"
744 "--------------\n"
745 "\n"));
746 ipstats(pData);
747 tcpstats(pData);
748 udpstats(pData);
749 icmpstats(pData);
750 mbufstats(pData);
751 sockstats(pData);
752 Log(("\n"
753 "\n"
754 "\n"));
755#endif
756 RTMemFree(pData);
757}
758
759
760#define CONN_CANFSEND(so) (((so)->so_state & (SS_FCANTSENDMORE|SS_ISFCONNECTED)) == SS_ISFCONNECTED)
761#define CONN_CANFRCV(so) (((so)->so_state & (SS_FCANTRCVMORE|SS_ISFCONNECTED)) == SS_ISFCONNECTED)
762
763/*
764 * curtime kept to an accuracy of 1ms
765 */
766static void updtime(PNATState pData)
767{
768#ifdef RT_OS_WINDOWS
769 struct _timeb tb;
770
771 _ftime(&tb);
772 curtime = (u_int)tb.time * (u_int)1000;
773 curtime += (u_int)tb.millitm;
774#else
775 gettimeofday(&tt, 0);
776
777 curtime = (u_int)tt.tv_sec * (u_int)1000;
778 curtime += (u_int)tt.tv_usec / (u_int)1000;
779
780 if ((tt.tv_usec % 1000) >= 500)
781 curtime++;
782#endif
783}
784
785#ifdef RT_OS_WINDOWS
786void slirp_select_fill(PNATState pData, int *pnfds)
787#else /* RT_OS_WINDOWS */
788void slirp_select_fill(PNATState pData, int *pnfds, struct pollfd *polls)
789#endif /* !RT_OS_WINDOWS */
790{
791 struct socket *so, *so_next;
792 int nfds;
793#if defined(RT_OS_WINDOWS)
794 int rc;
795 int error;
796#else
797 int poll_index = 0;
798#endif
799 int i;
800
801 STAM_PROFILE_START(&pData->StatFill, a);
802
803 nfds = *pnfds;
804
805 /*
806 * First, TCP sockets
807 */
808 do_slowtimo = 0;
809 if (!link_up)
810 goto done;
811
812 /*
813 * *_slowtimo needs calling if there are IP fragments
814 * in the fragment queue, or there are TCP connections active
815 */
816 /* XXX:
817 * triggering of fragment expiration should be the same but use new macroses
818 */
819 do_slowtimo = (tcb.so_next != &tcb);
820 if (!do_slowtimo)
821 {
822 for (i = 0; i < IPREASS_NHASH; i++)
823 {
824 if (!TAILQ_EMPTY(&ipq[i]))
825 {
826 do_slowtimo = 1;
827 break;
828 }
829 }
830 }
831 /* always add the ICMP socket */
832#ifndef RT_OS_WINDOWS
833 pData->icmp_socket.so_poll_index = -1;
834#endif
835 ICMP_ENGAGE_EVENT(&pData->icmp_socket, readfds);
836
837 STAM_COUNTER_RESET(&pData->StatTCP);
838 STAM_COUNTER_RESET(&pData->StatTCPHot);
839
840 QSOCKET_FOREACH(so, so_next, tcp)
841 /* { */
842#if !defined(RT_OS_WINDOWS)
843 so->so_poll_index = -1;
844#endif
845#ifndef VBOX_WITH_SLIRP_BSD_MBUF
846 if (pData->fmbuf_water_line == 1)
847 {
848 if (mbuf_alloced < pData->mbuf_water_line_limit/2)
849 {
850 pData->fmbuf_water_warn_sent = 0;
851 pData->fmbuf_water_line = 0;
852 }
853# ifndef RT_OS_WINDOWS
854 poll_index = 0;
855# endif
856 goto done;
857 }
858#endif /* !VBOX_WITH_SLIRP_BSD_MBUF */
859 STAM_COUNTER_INC(&pData->StatTCP);
860
861 /*
862 * See if we need a tcp_fasttimo
863 */
864 if ( time_fasttimo == 0
865 && so->so_tcpcb != NULL
866 && so->so_tcpcb->t_flags & TF_DELACK)
867 {
868 time_fasttimo = curtime; /* Flag when we want a fasttimo */
869 }
870
871 /*
872 * NOFDREF can include still connecting to local-host,
873 * newly socreated() sockets etc. Don't want to select these.
874 */
875 if (so->so_state & SS_NOFDREF || so->s == -1)
876 CONTINUE(tcp);
877
878 /*
879 * Set for reading sockets which are accepting
880 */
881 if (so->so_state & SS_FACCEPTCONN)
882 {
883 STAM_COUNTER_INC(&pData->StatTCPHot);
884 TCP_ENGAGE_EVENT1(so, readfds);
885 CONTINUE(tcp);
886 }
887
888 /*
889 * Set for writing sockets which are connecting
890 */
891 if (so->so_state & SS_ISFCONNECTING)
892 {
893 Log2(("connecting %R[natsock] engaged\n",so));
894 STAM_COUNTER_INC(&pData->StatTCPHot);
895 TCP_ENGAGE_EVENT1(so, writefds);
896 }
897
898 /*
899 * Set for writing if we are connected, can send more, and
900 * we have something to send
901 */
902 if (CONN_CANFSEND(so) && so->so_rcv.sb_cc)
903 {
904 STAM_COUNTER_INC(&pData->StatTCPHot);
905 TCP_ENGAGE_EVENT1(so, writefds);
906 }
907
908 /*
909 * Set for reading (and urgent data) if we are connected, can
910 * receive more, and we have room for it XXX /2 ?
911 */
912 if (CONN_CANFRCV(so) && (so->so_snd.sb_cc < (so->so_snd.sb_datalen/2)))
913 {
914 STAM_COUNTER_INC(&pData->StatTCPHot);
915 TCP_ENGAGE_EVENT2(so, readfds, xfds);
916 }
917 LOOP_LABEL(tcp, so, so_next);
918 }
919
920 /*
921 * UDP sockets
922 */
923 STAM_COUNTER_RESET(&pData->StatUDP);
924 STAM_COUNTER_RESET(&pData->StatUDPHot);
925
926 QSOCKET_FOREACH(so, so_next, udp)
927 /* { */
928
929#ifndef VBOX_WITH_SLIRP_BSD_MBUF
930 if (pData->fmbuf_water_line == 1)
931 {
932 if (mbuf_alloced < pData->mbuf_water_line_limit/2)
933 {
934 pData->fmbuf_water_line = 0;
935 pData->fmbuf_water_warn_sent = 0;
936 }
937# ifndef RT_OS_WINDOWS
938 poll_index = 0;
939# endif
940 goto done;
941 }
942#endif /* !VBOX_WITH_SLIRP_BSD_MBUF */
943 STAM_COUNTER_INC(&pData->StatUDP);
944#if !defined(RT_OS_WINDOWS)
945 so->so_poll_index = -1;
946#endif
947
948 /*
949 * See if it's timed out
950 */
951 if (so->so_expire)
952 {
953 if (so->so_expire <= curtime)
954 {
955 Log2(("NAT: %R[natsock] expired\n", so));
956 if (so->so_timeout != NULL)
957 {
958 so->so_timeout(pData, so, so->so_timeout_arg);
959 }
960#ifdef VBOX_WITH_SLIRP_MT
961 /* we need so_next for continue our cycle*/
962 so_next = so->so_next;
963#endif
964 UDP_DETACH(pData, so, so_next);
965 CONTINUE_NO_UNLOCK(udp);
966 }
967 else
968 {
969 do_slowtimo = 1; /* Let socket expire */
970 }
971 }
972
973 /*
974 * When UDP packets are received from over the link, they're
975 * sendto()'d straight away, so no need for setting for writing
976 * Limit the number of packets queued by this session to 4.
977 * Note that even though we try and limit this to 4 packets,
978 * the session could have more queued if the packets needed
979 * to be fragmented.
980 *
981 * (XXX <= 4 ?)
982 */
983 if ((so->so_state & SS_ISFCONNECTED) && so->so_queued <= 4)
984 {
985 STAM_COUNTER_INC(&pData->StatUDPHot);
986 UDP_ENGAGE_EVENT(so, readfds);
987 }
988 LOOP_LABEL(udp, so, so_next);
989 }
990done:
991
992#if defined(RT_OS_WINDOWS)
993 *pnfds = VBOX_EVENT_COUNT;
994#else /* RT_OS_WINDOWS */
995 AssertRelease(poll_index <= *pnfds);
996 *pnfds = poll_index;
997#endif /* !RT_OS_WINDOWS */
998
999 STAM_PROFILE_STOP(&pData->StatFill, a);
1000}
1001
1002#if defined(RT_OS_WINDOWS)
1003void slirp_select_poll(PNATState pData, int fTimeout, int fIcmp)
1004#else /* RT_OS_WINDOWS */
1005void slirp_select_poll(PNATState pData, struct pollfd *polls, int ndfs)
1006#endif /* !RT_OS_WINDOWS */
1007{
1008 struct socket *so, *so_next;
1009 int ret;
1010#if defined(RT_OS_WINDOWS)
1011 WSANETWORKEVENTS NetworkEvents;
1012 int rc;
1013 int error;
1014#else
1015 int poll_index = 0;
1016#endif
1017
1018 STAM_PROFILE_START(&pData->StatPoll, a);
1019
1020 /* Update time */
1021 updtime(pData);
1022
1023 /*
1024 * See if anything has timed out
1025 */
1026 if (link_up)
1027 {
1028 if (time_fasttimo && ((curtime - time_fasttimo) >= 2))
1029 {
1030 STAM_PROFILE_START(&pData->StatFastTimer, b);
1031 tcp_fasttimo(pData);
1032 time_fasttimo = 0;
1033 STAM_PROFILE_STOP(&pData->StatFastTimer, b);
1034 }
1035 if (do_slowtimo && ((curtime - last_slowtimo) >= 499))
1036 {
1037 STAM_PROFILE_START(&pData->StatSlowTimer, c);
1038 ip_slowtimo(pData);
1039 tcp_slowtimo(pData);
1040 last_slowtimo = curtime;
1041 STAM_PROFILE_STOP(&pData->StatSlowTimer, c);
1042 }
1043 }
1044#if defined(RT_OS_WINDOWS)
1045 if (fTimeout)
1046 return; /* only timer update */
1047#endif
1048
1049 /*
1050 * Check sockets
1051 */
1052 if (!link_up)
1053 goto done;
1054#if defined(RT_OS_WINDOWS)
1055 /*XXX: before renaming please make see define
1056 * fIcmp in slirp_state.h
1057 */
1058 if (fIcmp)
1059 sorecvfrom(pData, &pData->icmp_socket);
1060#else
1061 if ( (pData->icmp_socket.s != -1)
1062 && CHECK_FD_SET(&pData->icmp_socket, ignored, readfds))
1063 sorecvfrom(pData, &pData->icmp_socket);
1064#endif
1065 /*
1066 * Check TCP sockets
1067 */
1068 QSOCKET_FOREACH(so, so_next, tcp)
1069 /* { */
1070#ifndef VBOX_WITH_SLIRP_BSD_MBUF
1071 if (pData->fmbuf_water_line == 1)
1072 {
1073 if (mbuf_alloced < pData->mbuf_water_line_limit/2)
1074 {
1075 pData->fmbuf_water_line = 0;
1076 pData->fmbuf_water_warn_sent = 0;
1077 }
1078 goto done;
1079 }
1080#endif
1081
1082#ifdef VBOX_WITH_SLIRP_MT
1083 if ( so->so_state & SS_NOFDREF
1084 && so->so_deleted == 1)
1085 {
1086 struct socket *son, *sop = NULL;
1087 QSOCKET_LOCK(tcb);
1088 if (so->so_next != NULL)
1089 {
1090 if (so->so_next != &tcb)
1091 SOCKET_LOCK(so->so_next);
1092 son = so->so_next;
1093 }
1094 if ( so->so_prev != &tcb
1095 && so->so_prev != NULL)
1096 {
1097 SOCKET_LOCK(so->so_prev);
1098 sop = so->so_prev;
1099 }
1100 QSOCKET_UNLOCK(tcb);
1101 remque(pData, so);
1102 NSOCK_DEC();
1103 SOCKET_UNLOCK(so);
1104 SOCKET_LOCK_DESTROY(so);
1105 RTMemFree(so);
1106 so_next = son;
1107 if (sop != NULL)
1108 SOCKET_UNLOCK(sop);
1109 CONTINUE_NO_UNLOCK(tcp);
1110 }
1111#endif
1112 /*
1113 * FD_ISSET is meaningless on these sockets
1114 * (and they can crash the program)
1115 */
1116 if (so->so_state & SS_NOFDREF || so->s == -1)
1117 CONTINUE(tcp);
1118
1119 POLL_TCP_EVENTS(rc, error, so, &NetworkEvents);
1120
1121 LOG_NAT_SOCK(so, TCP, &NetworkEvents, readfds, writefds, xfds);
1122
1123
1124 /*
1125 * Check for URG data
1126 * This will soread as well, so no need to
1127 * test for readfds below if this succeeds
1128 */
1129
1130 /* out-of-band data */
1131 if ( CHECK_FD_SET(so, NetworkEvents, xfds)
1132#ifdef RT_OS_DARWIN
1133 /* Darwin and probably BSD hosts generates POLLPRI|POLLHUP event on receiving TCP.flags.{ACK|URG|FIN} this
1134 * combination on other Unixs hosts doesn't enter to this branch
1135 */
1136 && !CHECK_FD_SET(so, NetworkEvents, closefds)
1137#endif
1138 )
1139 {
1140 sorecvoob(pData, so);
1141 }
1142
1143 /*
1144 * Check sockets for reading
1145 */
1146 else if ( CHECK_FD_SET(so, NetworkEvents, readfds)
1147 || WIN_CHECK_FD_SET(so, NetworkEvents, acceptds))
1148 {
1149 /*
1150 * Check for incoming connections
1151 */
1152 if (so->so_state & SS_FACCEPTCONN)
1153 {
1154 TCP_CONNECT(pData, so);
1155 if (!CHECK_FD_SET(so, NetworkEvents, closefds))
1156 CONTINUE(tcp);
1157 }
1158
1159 ret = soread(pData, so);
1160 /* Output it if we read something */
1161 if (RT_LIKELY(ret > 0))
1162 TCP_OUTPUT(pData, sototcpcb(so));
1163 }
1164
1165 /*
1166 * Check for FD_CLOSE events.
1167 * in some cases once FD_CLOSE engaged on socket it could be flashed latter (for some reasons)
1168 */
1169 if ( CHECK_FD_SET(so, NetworkEvents, closefds)
1170 || (so->so_close == 1))
1171 {
1172 /*
1173 * drain the socket
1174 */
1175 for (;;)
1176 {
1177 ret = soread(pData, so);
1178 if (ret > 0)
1179 TCP_OUTPUT(pData, sototcpcb(so));
1180 else
1181 {
1182 Log2(("%R[natsock] errno %d:%s\n", so, errno, strerror(errno)));
1183 break;
1184 }
1185 }
1186 /* mark the socket for termination _after_ it was drained */
1187 so->so_close = 1;
1188 CONTINUE(tcp);
1189 }
1190
1191 /*
1192 * Check sockets for writing
1193 */
1194 if (CHECK_FD_SET(so, NetworkEvents, writefds))
1195 {
1196 /*
1197 * Check for non-blocking, still-connecting sockets
1198 */
1199 if (so->so_state & SS_ISFCONNECTING)
1200 {
1201 Log2(("connecting %R[natsock] catched\n", so));
1202 /* Connected */
1203 so->so_state &= ~SS_ISFCONNECTING;
1204
1205 /*
1206 * This should be probably guarded by PROBE_CONN too. Anyway,
1207 * we disable it on OS/2 because the below send call returns
1208 * EFAULT which causes the opened TCP socket to close right
1209 * after it has been opened and connected.
1210 */
1211#ifndef RT_OS_OS2
1212 ret = send(so->s, (const char *)&ret, 0, 0);
1213 if (ret < 0)
1214 {
1215 /* XXXXX Must fix, zero bytes is a NOP */
1216 if ( errno == EAGAIN
1217 || errno == EWOULDBLOCK
1218 || errno == EINPROGRESS
1219 || errno == ENOTCONN)
1220 CONTINUE(tcp);
1221
1222 /* else failed */
1223 so->so_state = SS_NOFDREF;
1224 }
1225 /* else so->so_state &= ~SS_ISFCONNECTING; */
1226#endif
1227
1228 /*
1229 * Continue tcp_input
1230 */
1231 TCP_INPUT(pData, (struct mbuf *)NULL, sizeof(struct ip), so);
1232 /* continue; */
1233 }
1234 else
1235 SOWRITE(ret, pData, so);
1236 /*
1237 * XXX If we wrote something (a lot), there could be the need
1238 * for a window update. In the worst case, the remote will send
1239 * a window probe to get things going again.
1240 */
1241 }
1242
1243 /*
1244 * Probe a still-connecting, non-blocking socket
1245 * to check if it's still alive
1246 */
1247#ifdef PROBE_CONN
1248 if (so->so_state & SS_ISFCONNECTING)
1249 {
1250 ret = recv(so->s, (char *)&ret, 0, 0);
1251
1252 if (ret < 0)
1253 {
1254 /* XXX */
1255 if ( errno == EAGAIN
1256 || errno == EWOULDBLOCK
1257 || errno == EINPROGRESS
1258 || errno == ENOTCONN)
1259 {
1260 CONTINUE(tcp); /* Still connecting, continue */
1261 }
1262
1263 /* else failed */
1264 so->so_state = SS_NOFDREF;
1265
1266 /* tcp_input will take care of it */
1267 }
1268 else
1269 {
1270 ret = send(so->s, &ret, 0, 0);
1271 if (ret < 0)
1272 {
1273 /* XXX */
1274 if ( errno == EAGAIN
1275 || errno == EWOULDBLOCK
1276 || errno == EINPROGRESS
1277 || errno == ENOTCONN)
1278 {
1279 CONTINUE(tcp);
1280 }
1281 /* else failed */
1282 so->so_state = SS_NOFDREF;
1283 }
1284 else
1285 so->so_state &= ~SS_ISFCONNECTING;
1286
1287 }
1288 TCP_INPUT((struct mbuf *)NULL, sizeof(struct ip),so);
1289 } /* SS_ISFCONNECTING */
1290#endif
1291 LOOP_LABEL(tcp, so, so_next);
1292 }
1293
1294 /*
1295 * Now UDP sockets.
1296 * Incoming packets are sent straight away, they're not buffered.
1297 * Incoming UDP data isn't buffered either.
1298 */
1299 QSOCKET_FOREACH(so, so_next, udp)
1300 /* { */
1301#ifndef VBOX_WITH_SLIRP_BSD_MBUF
1302 if (pData->fmbuf_water_line == 1)
1303 {
1304 if (mbuf_alloced < pData->mbuf_water_line_limit/2)
1305 {
1306 pData->fmbuf_water_line = 0;
1307 pData->fmbuf_water_warn_sent = 0;
1308 }
1309 goto done;
1310 }
1311#endif
1312#ifdef VBOX_WITH_SLIRP_MT
1313 if ( so->so_state & SS_NOFDREF
1314 && so->so_deleted == 1)
1315 {
1316 struct socket *son, *sop = NULL;
1317 QSOCKET_LOCK(udb);
1318 if (so->so_next != NULL)
1319 {
1320 if (so->so_next != &udb)
1321 SOCKET_LOCK(so->so_next);
1322 son = so->so_next;
1323 }
1324 if ( so->so_prev != &udb
1325 && so->so_prev != NULL)
1326 {
1327 SOCKET_LOCK(so->so_prev);
1328 sop = so->so_prev;
1329 }
1330 QSOCKET_UNLOCK(udb);
1331 remque(pData, so);
1332 NSOCK_DEC();
1333 SOCKET_UNLOCK(so);
1334 SOCKET_LOCK_DESTROY(so);
1335 RTMemFree(so);
1336 so_next = son;
1337 if (sop != NULL)
1338 SOCKET_UNLOCK(sop);
1339 CONTINUE_NO_UNLOCK(udp);
1340 }
1341#endif
1342 POLL_UDP_EVENTS(rc, error, so, &NetworkEvents);
1343
1344 LOG_NAT_SOCK(so, UDP, &NetworkEvents, readfds, writefds, xfds);
1345
1346 if (so->s != -1 && CHECK_FD_SET(so, NetworkEvents, readfds))
1347 {
1348 SORECVFROM(pData, so);
1349 }
1350 LOOP_LABEL(udp, so, so_next);
1351 }
1352
1353done:
1354#if 0
1355 /*
1356 * See if we can start outputting
1357 */
1358 if (if_queued && link_up)
1359 if_start(pData);
1360#endif
1361
1362 STAM_PROFILE_STOP(&pData->StatPoll, a);
1363}
1364
1365
1366struct arphdr
1367{
1368 unsigned short ar_hrd; /* format of hardware address */
1369 unsigned short ar_pro; /* format of protocol address */
1370 unsigned char ar_hln; /* length of hardware address */
1371 unsigned char ar_pln; /* length of protocol address */
1372 unsigned short ar_op; /* ARP opcode (command) */
1373
1374 /*
1375 * Ethernet looks like this : This bit is variable sized however...
1376 */
1377 unsigned char ar_sha[ETH_ALEN]; /* sender hardware address */
1378 unsigned char ar_sip[4]; /* sender IP address */
1379 unsigned char ar_tha[ETH_ALEN]; /* target hardware address */
1380 unsigned char ar_tip[4]; /* target IP address */
1381};
1382AssertCompileSize(struct arphdr, 28);
1383
1384static void arp_input(PNATState pData, struct mbuf *m)
1385{
1386 struct ethhdr *eh;
1387 struct ethhdr *reh;
1388 struct arphdr *ah;
1389 struct arphdr *rah;
1390 int ar_op;
1391 uint32_t htip;
1392 uint32_t tip;
1393 struct mbuf *mr;
1394 eh = mtod(m, struct ethhdr *);
1395 ah = (struct arphdr *)&eh[1];
1396 htip = RT_N2H_U32(*(uint32_t*)ah->ar_tip);
1397 tip = *(uint32_t*)ah->ar_tip;
1398
1399 ar_op = RT_N2H_U16(ah->ar_op);
1400
1401 switch (ar_op)
1402 {
1403 case ARPOP_REQUEST:
1404#ifndef VBOX_WITH_SLIRP_BSD_MBUF
1405 mr = m_get(pData);
1406
1407 reh = mtod(mr, struct ethhdr *);
1408 memcpy(reh->h_source, eh->h_source, ETH_ALEN); /* XXX: if_encap will swap src and dst*/
1409 Log4(("NAT: arp:%R[ether]->%R[ether]\n",
1410 reh->h_source, reh->h_dest));
1411 Log4(("NAT: arp: %R[IP4]\n", &tip));
1412
1413 mr->m_data += if_maxlinkhdr;
1414 mr->m_len = sizeof(struct arphdr);
1415 rah = mtod(mr, struct arphdr *);
1416#else
1417 mr = m_getcl(pData, M_NOWAIT, MT_HEADER, M_PKTHDR);
1418 reh = mtod(mr, struct ethhdr *);
1419 mr->m_data += ETH_HLEN;
1420 rah = mtod(mr, struct arphdr *);
1421 mr->m_len = sizeof(struct arphdr);
1422 Assert(mr);
1423 memcpy(reh->h_source, eh->h_source, ETH_ALEN); /* XXX: if_encap will swap src and dst*/
1424#endif
1425#ifdef VBOX_WITH_NAT_SERVICE
1426 if (tip == pData->special_addr.s_addr)
1427 goto arp_ok;
1428#endif
1429 if ((htip & pData->netmask) == RT_N2H_U32(pData->special_addr.s_addr))
1430 {
1431 if ( CTL_CHECK(htip, CTL_DNS)
1432 || CTL_CHECK(htip, CTL_ALIAS)
1433 || CTL_CHECK(htip, CTL_TFTP))
1434 goto arp_ok;
1435 m_free(pData, m);
1436 m_free(pData, mr);
1437 return;
1438
1439 arp_ok:
1440 rah->ar_hrd = RT_H2N_U16_C(1);
1441 rah->ar_pro = RT_H2N_U16_C(ETH_P_IP);
1442 rah->ar_hln = ETH_ALEN;
1443 rah->ar_pln = 4;
1444 rah->ar_op = RT_H2N_U16_C(ARPOP_REPLY);
1445 memcpy(rah->ar_sha, special_ethaddr, ETH_ALEN);
1446
1447 switch (htip & ~pData->netmask)
1448 {
1449 case CTL_DNS:
1450 case CTL_ALIAS:
1451 rah->ar_sha[5] = (uint8_t)(htip & ~pData->netmask);
1452 break;
1453 default:;
1454 }
1455
1456 memcpy(rah->ar_sip, ah->ar_tip, 4);
1457 memcpy(rah->ar_tha, ah->ar_sha, ETH_ALEN);
1458 memcpy(rah->ar_tip, ah->ar_sip, 4);
1459 if_encap(pData, ETH_P_ARP, mr, ETH_ENCAP_URG);
1460 m_free(pData, m);
1461 }
1462 /* Gratuitous ARP */
1463 if ( *(uint32_t *)ah->ar_sip == *(uint32_t *)ah->ar_tip
1464 && memcmp(ah->ar_tha, broadcast_ethaddr, ETH_ALEN) == 0
1465 && memcmp(eh->h_dest, broadcast_ethaddr, ETH_ALEN) == 0)
1466 {
1467 /* we've received anounce about address asignment
1468 * Let's do ARP cache update
1469 */
1470 if (slirp_arp_cache_update(pData, *(uint32_t *)ah->ar_tip, &eh->h_dest[0]) == 0)
1471 {
1472 m_free(pData, mr);
1473 m_free(pData, m);
1474 break;
1475 }
1476 slirp_arp_cache_add(pData, *(uint32_t *)ah->ar_tip, &eh->h_dest[0]);
1477 }
1478 break;
1479
1480 case ARPOP_REPLY:
1481 if (slirp_arp_cache_update(pData, *(uint32_t *)ah->ar_sip, &ah->ar_sha[0]) == 0)
1482 {
1483 m_free(pData, m);
1484 break;
1485 }
1486 slirp_arp_cache_add(pData, *(uint32_t *)ah->ar_sip, ah->ar_sha);
1487 m_free(pData, m);
1488 break;
1489
1490 default:
1491 break;
1492 }
1493}
1494
1495/**
1496 * Feed a packet into the slirp engine.
1497 *
1498 * @param m Data buffer, m_len is not valid.
1499 * @param cbBuf The length of the data in m.
1500 */
1501void slirp_input(PNATState pData, struct mbuf *m, size_t cbBuf)
1502{
1503 int proto;
1504 static bool fWarnedIpv6;
1505 struct ethhdr *eh;
1506 uint8_t au8Ether[ETH_ALEN];
1507
1508 m->m_len = cbBuf;
1509 if (cbBuf < ETH_HLEN)
1510 {
1511 LogRel(("NAT: packet having size %d has been ignored\n", m->m_len));
1512 m_free(pData, m);
1513 return;
1514 }
1515 eh = mtod(m, struct ethhdr *);
1516 proto = RT_N2H_U16(eh->h_proto);
1517
1518 memcpy(au8Ether, eh->h_source, ETH_ALEN);
1519
1520 switch(proto)
1521 {
1522 case ETH_P_ARP:
1523 arp_input(pData, m);
1524 break;
1525
1526 case ETH_P_IP:
1527 /* Update time. Important if the network is very quiet, as otherwise
1528 * the first outgoing connection gets an incorrect timestamp. */
1529 updtime(pData);
1530 m_adj(m, ETH_HLEN);
1531#ifdef VBOX_WITH_SLIRP_BSD_MBUF
1532 M_ASSERTPKTHDR(m);
1533 m->m_pkthdr.header = mtod(m, void *);
1534#else /* !VBOX_WITH_SLIRP_BSD_MBUF */
1535 if ( pData->fmbuf_water_line
1536 && pData->fmbuf_water_warn_sent == 0
1537 && (curtime - pData->tsmbuf_water_warn_sent) > 500)
1538 {
1539 icmp_error(pData, m, ICMP_SOURCEQUENCH, 0, 0, "Out of resources!!!");
1540 pData->fmbuf_water_warn_sent = 1;
1541 pData->tsmbuf_water_warn_sent = curtime;
1542 }
1543#endif /* !VBOX_WITH_SLIRP_BSD_MBUF */
1544 ip_input(pData, m);
1545 break;
1546
1547 case ETH_P_IPV6:
1548 m_free(pData, m);
1549 if (!fWarnedIpv6)
1550 {
1551 LogRel(("NAT: IPv6 not supported\n"));
1552 fWarnedIpv6 = true;
1553 }
1554 break;
1555
1556 default:
1557 Log(("NAT: Unsupported protocol %x\n", proto));
1558 m_free(pData, m);
1559 break;
1560 }
1561
1562 if (pData->cRedirectionsActive != pData->cRedirectionsStored)
1563 activate_port_forwarding(pData, au8Ether);
1564}
1565
1566/* output the IP packet to the ethernet device */
1567void if_encap(PNATState pData, uint16_t eth_proto, struct mbuf *m, int flags)
1568{
1569 struct ethhdr *eh;
1570 uint8_t *buf = NULL;
1571 size_t mlen = 0;
1572 STAM_PROFILE_START(&pData->StatIF_encap, a);
1573
1574#ifndef VBOX_WITH_SLIRP_BSD_MBUF
1575 m->m_data -= if_maxlinkhdr;
1576 m->m_len += ETH_HLEN;
1577 eh = mtod(m, struct ethhdr *);
1578
1579 if (MBUF_HEAD(m) != m->m_data)
1580 {
1581 LogRel(("NAT: ethernet detects corruption of the packet"));
1582 AssertMsgFailed(("!!Ethernet frame corrupted!!"));
1583 }
1584#else
1585 M_ASSERTPKTHDR(m);
1586 m->m_data -= ETH_HLEN;
1587 m->m_len += ETH_HLEN;
1588 eh = mtod(m, struct ethhdr *);
1589#endif
1590
1591 if (memcmp(eh->h_source, special_ethaddr, ETH_ALEN) != 0)
1592 {
1593 memcpy(eh->h_dest, eh->h_source, ETH_ALEN);
1594 memcpy(eh->h_source, special_ethaddr, ETH_ALEN);
1595 Assert(memcmp(eh->h_dest, special_ethaddr, ETH_ALEN) != 0);
1596 if (memcmp(eh->h_dest, zerro_ethaddr, ETH_ALEN) == 0)
1597 {
1598 /* don't do anything */
1599 m_free(pData, m);
1600 goto done;
1601 }
1602 }
1603#ifndef VBOX_WITH_SLIRP_BSD_MBUF
1604 mlen = m->m_len;
1605#else
1606 mlen = m_length(m, NULL);
1607 buf = RTMemAlloc(mlen);
1608 if (buf == NULL)
1609 {
1610 LogRel(("NAT: Can't alloc memory for outgoing buffer\n"));
1611 m_free(pData, m);
1612 goto done;
1613 }
1614#endif
1615 eh->h_proto = RT_H2N_U16(eth_proto);
1616#ifdef VBOX_WITH_SLIRP_BSD_MBUF
1617 m_copydata(m, 0, mlen, (char *)buf);
1618 if (flags & ETH_ENCAP_URG)
1619 slirp_urg_output(pData->pvUser, m, buf, mlen);
1620 else
1621 slirp_output(pData->pvUser, m, buf, mlen);
1622#else
1623 if (flags & ETH_ENCAP_URG)
1624 slirp_urg_output(pData->pvUser, m, mtod(m, const uint8_t *), mlen);
1625 else
1626 slirp_output(pData->pvUser, m, mtod(m, const uint8_t *), mlen);
1627#endif
1628done:
1629 STAM_PROFILE_STOP(&pData->StatIF_encap, a);
1630}
1631
1632/**
1633 * Still we're using dhcp server leasing to map ether to IP
1634 * @todo see rt_lookup_in_cache
1635 */
1636static uint32_t find_guest_ip(PNATState pData, const uint8_t *eth_addr)
1637{
1638 uint32_t ip = INADDR_ANY;
1639 int rc;
1640
1641 if (eth_addr == NULL)
1642 return INADDR_ANY;
1643
1644 if ( memcmp(eth_addr, zerro_ethaddr, ETH_ALEN) == 0
1645 || memcmp(eth_addr, broadcast_ethaddr, ETH_ALEN) == 0)
1646 return INADDR_ANY;
1647
1648 rc = slirp_arp_lookup_ip_by_ether(pData, eth_addr, &ip);
1649 if (RT_SUCCESS(rc))
1650 return ip;
1651
1652 bootp_cache_lookup_ip_by_ether(pData, eth_addr, &ip);
1653 /* ignore return code, ip will be set to INADDR_ANY on error */
1654 return ip;
1655}
1656
1657/**
1658 * We need check if we've activated port forwarding
1659 * for specific machine ... that of course relates to
1660 * service mode
1661 * @todo finish this for service case
1662 */
1663static void activate_port_forwarding(PNATState pData, const uint8_t *h_source)
1664{
1665 struct port_forward_rule *rule;
1666
1667 /* check mac here */
1668 LIST_FOREACH(rule, &pData->port_forward_rule_head, list)
1669 {
1670 struct socket *so;
1671 struct alias_link *alias_link;
1672 struct libalias *lib;
1673 int flags;
1674 struct sockaddr sa;
1675 struct sockaddr_in *psin;
1676 socklen_t socketlen;
1677 struct in_addr alias;
1678 int rc;
1679 uint32_t guest_addr; /* need to understand if we already give address to guest */
1680
1681 if (rule->activated)
1682 continue;
1683
1684#ifdef VBOX_WITH_NAT_SERVICE
1685 if (memcmp(rule->mac_address, h_source, ETH_ALEN) != 0)
1686 continue; /*not right mac, @todo: it'd be better do the list port forwarding per mac */
1687 guest_addr = find_guest_ip(pData, h_source);
1688#else
1689#if 0
1690 if (memcmp(client_ethaddr, h_source, ETH_ALEN) != 0)
1691 continue;
1692#endif
1693 guest_addr = find_guest_ip(pData, h_source);
1694#endif
1695 if (guest_addr == INADDR_ANY)
1696 {
1697 /* the address wasn't granted */
1698 return;
1699 }
1700
1701#if !defined(VBOX_WITH_NAT_SERVICE)
1702 if (rule->guest_addr.s_addr != guest_addr)
1703 continue;
1704#endif
1705
1706 LogRel(("NAT: set redirect %s host port %d => guest port %d @ %R[IP4]\n",
1707 (rule->proto == IPPROTO_UDP?"UDP":"TCP"),
1708 rule->host_port, rule->guest_port, &guest_addr));
1709
1710 if (rule->proto == IPPROTO_UDP)
1711 so = udp_listen(pData, rule->bind_ip.s_addr, RT_H2N_U16(rule->host_port), guest_addr,
1712 RT_H2N_U16(rule->guest_port), 0);
1713 else
1714 so = solisten(pData, rule->bind_ip.s_addr, RT_H2N_U16(rule->host_port), guest_addr,
1715 RT_H2N_U16(rule->guest_port), 0);
1716
1717 if (so == NULL)
1718 goto remove_port_forwarding;
1719
1720 psin = (struct sockaddr_in *)&sa;
1721 psin->sin_family = AF_INET;
1722 psin->sin_port = 0;
1723 psin->sin_addr.s_addr = INADDR_ANY;
1724 socketlen = sizeof(struct sockaddr);
1725
1726 rc = getsockname(so->s, &sa, &socketlen);
1727 if (rc < 0 || sa.sa_family != AF_INET)
1728 goto remove_port_forwarding;
1729
1730 psin = (struct sockaddr_in *)&sa;
1731
1732 lib = LibAliasInit(pData, NULL);
1733 flags = LibAliasSetMode(lib, 0, 0);
1734 flags |= PKT_ALIAS_LOG; /* set logging */
1735 flags |= PKT_ALIAS_PROXY_ONLY; /* do transparent proxying */
1736 flags |= PKT_ALIAS_REVERSE; /* set logging */
1737 flags = LibAliasSetMode(lib, flags, ~0);
1738
1739 alias.s_addr = RT_H2N_U32(RT_N2H_U32(guest_addr) | CTL_ALIAS);
1740 alias_link = LibAliasRedirectPort(lib, psin->sin_addr, RT_H2N_U16(rule->host_port),
1741 alias, RT_H2N_U16(rule->guest_port),
1742 pData->special_addr, -1, /* not very clear for now */
1743 rule->proto);
1744 if (!alias_link)
1745 goto remove_port_forwarding;
1746
1747 so->so_la = lib;
1748 rule->activated = 1;
1749 pData->cRedirectionsActive++;
1750 continue;
1751
1752 remove_port_forwarding:
1753 LogRel(("NAT: failed to redirect %s %d => %d\n",
1754 (rule->proto == IPPROTO_UDP?"UDP":"TCP"), rule->host_port, rule->guest_port));
1755 LIST_REMOVE(rule, list);
1756 pData->cRedirectionsStored--;
1757 RTMemFree(rule);
1758 }
1759}
1760
1761/**
1762 * Changes in 3.1 instead of opening new socket do the following:
1763 * gain more information:
1764 * 1. bind IP
1765 * 2. host port
1766 * 3. guest port
1767 * 4. proto
1768 * 5. guest MAC address
1769 * the guest's MAC address is rather important for service, but we easily
1770 * could get it from VM configuration in DrvNAT or Service, the idea is activating
1771 * corresponding port-forwarding
1772 */
1773int slirp_redir(PNATState pData, int is_udp, struct in_addr host_addr, int host_port,
1774 struct in_addr guest_addr, int guest_port, const uint8_t *ethaddr)
1775{
1776 struct port_forward_rule *rule = NULL;
1777 Assert(memcmp(ethaddr, zerro_ethaddr, ETH_ALEN) == 0);
1778
1779 rule = RTMemAllocZ(sizeof(struct port_forward_rule));
1780 if (rule == NULL)
1781 return 1;
1782
1783 rule->proto = (is_udp ? IPPROTO_UDP : IPPROTO_TCP);
1784 rule->host_port = host_port;
1785 rule->guest_port = guest_port;
1786#ifndef VBOX_WITH_NAT_SERVICE
1787 rule->guest_addr.s_addr = guest_addr.s_addr;
1788#endif
1789 rule->bind_ip.s_addr = host_addr.s_addr;
1790 memcpy(rule->mac_address, ethaddr, ETH_ALEN);
1791 /* @todo add mac address */
1792 LIST_INSERT_HEAD(&pData->port_forward_rule_head, rule, list);
1793 pData->cRedirectionsStored++;
1794 return 0;
1795}
1796
1797void slirp_set_ethaddr_and_activate_port_forwarding(PNATState pData, const uint8_t *ethaddr, uint32_t GuestIP)
1798{
1799#ifndef VBOX_WITH_NAT_SERVICE
1800 memcpy(client_ethaddr, ethaddr, ETH_ALEN);
1801#endif
1802 if (GuestIP != INADDR_ANY)
1803 {
1804 slirp_arp_cache_update_or_add(pData, GuestIP, ethaddr);
1805 activate_port_forwarding(pData, ethaddr);
1806 }
1807}
1808
1809#if defined(RT_OS_WINDOWS)
1810HANDLE *slirp_get_events(PNATState pData)
1811{
1812 return pData->phEvents;
1813}
1814void slirp_register_external_event(PNATState pData, HANDLE hEvent, int index)
1815{
1816 pData->phEvents[index] = hEvent;
1817}
1818#endif
1819
1820unsigned int slirp_get_timeout_ms(PNATState pData)
1821{
1822 if (link_up)
1823 {
1824 if (time_fasttimo)
1825 return 2;
1826 if (do_slowtimo)
1827 return 500; /* see PR_SLOWHZ */
1828 }
1829 return 3600*1000; /* one hour */
1830}
1831
1832#ifndef RT_OS_WINDOWS
1833int slirp_get_nsock(PNATState pData)
1834{
1835 return pData->nsock;
1836}
1837#endif
1838
1839/*
1840 * this function called from NAT thread
1841 */
1842void slirp_post_sent(PNATState pData, void *pvArg)
1843{
1844 struct socket *so = 0;
1845 struct tcpcb *tp = 0;
1846 struct mbuf *m = (struct mbuf *)pvArg;
1847 m_free(pData, m);
1848}
1849#ifdef VBOX_WITH_SLIRP_MT
1850void slirp_process_queue(PNATState pData)
1851{
1852 RTReqProcess(pData->pReqQueue, RT_INDEFINITE_WAIT);
1853}
1854void *slirp_get_queue(PNATState pData)
1855{
1856 return pData->pReqQueue;
1857}
1858#endif
1859
1860void slirp_set_dhcp_TFTP_prefix(PNATState pData, const char *tftpPrefix)
1861{
1862 Log2(("tftp_prefix:%s\n", tftpPrefix));
1863 tftp_prefix = tftpPrefix;
1864}
1865
1866void slirp_set_dhcp_TFTP_bootfile(PNATState pData, const char *bootFile)
1867{
1868 Log2(("bootFile:%s\n", bootFile));
1869 bootp_filename = bootFile;
1870}
1871
1872void slirp_set_dhcp_next_server(PNATState pData, const char *next_server)
1873{
1874 Log2(("next_server:%s\n", next_server));
1875 if (next_server == NULL)
1876 pData->tftp_server.s_addr = RT_H2N_U32(RT_N2H_U32(pData->special_addr.s_addr) | CTL_TFTP);
1877 else
1878 inet_aton(next_server, &pData->tftp_server);
1879}
1880
1881int slirp_set_binding_address(PNATState pData, char *addr)
1882{
1883 if (addr == NULL || (inet_aton(addr, &pData->bindIP) == 0))
1884 {
1885 pData->bindIP.s_addr = INADDR_ANY;
1886 return 1;
1887 }
1888 return 0;
1889}
1890
1891void slirp_set_dhcp_dns_proxy(PNATState pData, bool fDNSProxy)
1892{
1893 if (!pData->fUseHostResolver)
1894 {
1895 Log2(("NAT: DNS proxy switched %s\n", (fDNSProxy ? "on" : "off")));
1896 pData->fUseDnsProxy = fDNSProxy;
1897 }
1898 else
1899 LogRel(("NAT: Host Resolver conflicts with DNS proxy, the last one was forcely ignored\n"));
1900}
1901
1902#define CHECK_ARG(name, val, lim_min, lim_max) \
1903 do { \
1904 if ((val) < (lim_min) || (val) > (lim_max)) \
1905 { \
1906 LogRel(("NAT: (" #name ":%d) has been ignored, " \
1907 "because out of range (%d, %d)\n", (val), (lim_min), (lim_max))); \
1908 return; \
1909 } \
1910 else \
1911 LogRel(("NAT: (" #name ":%d)\n", (val))); \
1912 } while (0)
1913
1914/* don't allow user set less 8kB and more than 1M values */
1915#define _8K_1M_CHECK_ARG(name, val) CHECK_ARG(name, (val), 8, 1024)
1916void slirp_set_rcvbuf(PNATState pData, int kilobytes)
1917{
1918 _8K_1M_CHECK_ARG("SOCKET_RCVBUF", kilobytes);
1919 pData->socket_rcv = kilobytes;
1920}
1921void slirp_set_sndbuf(PNATState pData, int kilobytes)
1922{
1923 _8K_1M_CHECK_ARG("SOCKET_SNDBUF", kilobytes);
1924 pData->socket_snd = kilobytes * _1K;
1925}
1926void slirp_set_tcp_rcvspace(PNATState pData, int kilobytes)
1927{
1928 _8K_1M_CHECK_ARG("TCP_RCVSPACE", kilobytes);
1929 tcp_rcvspace = kilobytes * _1K;
1930}
1931void slirp_set_tcp_sndspace(PNATState pData, int kilobytes)
1932{
1933 _8K_1M_CHECK_ARG("TCP_SNDSPACE", kilobytes);
1934 tcp_sndspace = kilobytes * _1K;
1935}
1936
1937/*
1938 * Looking for Ether by ip in ARP-cache
1939 * Note: it´s responsible of caller to allocate buffer for result
1940 * @returns iprt status code
1941 */
1942int slirp_arp_lookup_ether_by_ip(PNATState pData, uint32_t ip, uint8_t *ether)
1943{
1944 struct arp_cache_entry *ac;
1945
1946 if (ether == NULL)
1947 return VERR_INVALID_PARAMETER;
1948
1949 if (LIST_EMPTY(&pData->arp_cache))
1950 return VERR_NOT_FOUND;
1951
1952 LIST_FOREACH(ac, &pData->arp_cache, list)
1953 {
1954 if (ac->ip == ip)
1955 {
1956 memcpy(ether, ac->ether, ETH_ALEN);
1957 return VINF_SUCCESS;
1958 }
1959 }
1960 return VERR_NOT_FOUND;
1961}
1962
1963/*
1964 * Looking for IP by Ether in ARP-cache
1965 * Note: it´s responsible of caller to allocate buffer for result
1966 * @returns 0 - if found, 1 - otherwise
1967 */
1968int slirp_arp_lookup_ip_by_ether(PNATState pData, const uint8_t *ether, uint32_t *ip)
1969{
1970 struct arp_cache_entry *ac;
1971 *ip = INADDR_ANY;
1972
1973 if (LIST_EMPTY(&pData->arp_cache))
1974 return VERR_NOT_FOUND;
1975
1976 LIST_FOREACH(ac, &pData->arp_cache, list)
1977 {
1978 if (memcmp(ether, ac->ether, ETH_ALEN) == 0)
1979 {
1980 *ip = ac->ip;
1981 return VINF_SUCCESS;
1982 }
1983 }
1984 return VERR_NOT_FOUND;
1985}
1986
1987void slirp_arp_who_has(PNATState pData, uint32_t dst)
1988{
1989 struct mbuf *m;
1990 struct ethhdr *ehdr;
1991 struct arphdr *ahdr;
1992
1993#ifndef VBOX_WITH_SLIRP_BSD_MBUF
1994 m = m_get(pData);
1995#else
1996 m = m_getcl(pData, M_NOWAIT, MT_HEADER, M_PKTHDR);
1997#endif
1998 if (m == NULL)
1999 {
2000 LogRel(("NAT: Can't alloc mbuf for ARP request\n"));
2001 return;
2002 }
2003 ehdr = mtod(m, struct ethhdr *);
2004 memset(ehdr->h_source, 0xff, ETH_ALEN);
2005 ahdr = (struct arphdr *)&ehdr[1];
2006 ahdr->ar_hrd = RT_H2N_U16_C(1);
2007 ahdr->ar_pro = RT_H2N_U16_C(ETH_P_IP);
2008 ahdr->ar_hln = ETH_ALEN;
2009 ahdr->ar_pln = 4;
2010 ahdr->ar_op = RT_H2N_U16_C(ARPOP_REQUEST);
2011 memcpy(ahdr->ar_sha, special_ethaddr, ETH_ALEN);
2012 *(uint32_t *)ahdr->ar_sip = RT_H2N_U32(RT_N2H_U32(pData->special_addr.s_addr) | CTL_ALIAS);
2013 memset(ahdr->ar_tha, 0xff, ETH_ALEN); /*broadcast*/
2014 *(uint32_t *)ahdr->ar_tip = dst;
2015#ifndef VBOX_WITH_SLIRP_BSD_MBUF
2016 m->m_data += if_maxlinkhdr;
2017 m->m_len = sizeof(struct arphdr);
2018#else
2019 /* warn!!! should falls in mbuf minimal size */
2020 m->m_len = sizeof(struct arphdr) + ETH_HLEN;
2021 m->m_data += ETH_HLEN;
2022 m->m_len -= ETH_HLEN;
2023#endif
2024 if_encap(pData, ETH_P_ARP, m, ETH_ENCAP_URG);
2025}
2026
2027int slirp_arp_cache_update_or_add(PNATState pData, uint32_t dst, const uint8_t *mac)
2028{
2029 if (slirp_arp_cache_update(pData, dst, mac))
2030 slirp_arp_cache_add(pData, dst, mac);
2031
2032 return 0;
2033}
2034
2035/* updates the arp cache
2036 * @returns 0 - if has found and updated
2037 * 1 - if hasn't found.
2038 */
2039int slirp_arp_cache_update(PNATState pData, uint32_t dst, const uint8_t *mac)
2040{
2041 struct arp_cache_entry *ac;
2042 LIST_FOREACH(ac, &pData->arp_cache, list)
2043 {
2044 if (memcmp(ac->ether, mac, ETH_ALEN) == 0)
2045 {
2046 ac->ip = dst;
2047 return 0;
2048 }
2049 }
2050 return 1;
2051}
2052
2053void slirp_arp_cache_add(PNATState pData, uint32_t ip, const uint8_t *ether)
2054{
2055 struct arp_cache_entry *ac = NULL;
2056 ac = RTMemAllocZ(sizeof(struct arp_cache_entry));
2057 if (ac == NULL)
2058 {
2059 LogRel(("NAT: Can't allocate arp cache entry\n"));
2060 return;
2061 }
2062 ac->ip = ip;
2063 memcpy(ac->ether, ether, ETH_ALEN);
2064 LIST_INSERT_HEAD(&pData->arp_cache, ac, list);
2065}
2066
2067#ifdef VBOX_WITH_SLIRP_BSD_MBUF
2068void slirp_set_mtu(PNATState pData, int mtu)
2069{
2070 if (mtu < 20 || mtu >= 16000)
2071 {
2072 LogRel(("NAT: mtu(%d) is out of range (20;16000] mtu forcely assigned to 1500\n", mtu));
2073 mtu = 1500;
2074 }
2075 if_mtu =
2076 if_mru = mtu;
2077}
2078#endif
Note: See TracBrowser for help on using the repository browser.

© 2024 Oracle Support Privacy / Do Not Sell My Info Terms of Use Trademark Policy Automated Access Etiquette