socket.c revision e590d0cde1cc5c94333f97c13b9f12ae56fbf8bc
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Copyright (c) 1995 Danny Gasparovski.
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync *
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Please read the file COPYRIGHT for the
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * terms and conditions of the copyright.
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#define WANT_SYS_IOCTL_H
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#include <slirp.h>
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#include "ip_icmp.h"
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#include "main.h"
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifdef __sun__
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#include <sys/filio.h>
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if defined(VBOX_WITH_SLIRP_ICMP) && defined (RT_OS_WINDOWS)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#include <iphlpapi.h>
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#include <icmpapi.h>
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifdef VBOX_WITH_SLIRP_ICMP
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstatic void send_icmp_to_guest(PNATState, char *, size_t, struct socket *, const struct sockaddr_in *);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstatic void sorecvfrom_icmp_win(PNATState, struct socket *);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstatic void sorecvfrom_icmp_unix(PNATState, struct socket *);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncso_init()
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstruct socket *
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsolookup(struct socket *head, struct in_addr laddr,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync u_int lport, struct in_addr faddr, u_int fport)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync struct socket *so;
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync for (so = head->so_next; so != head; so = so->so_next)
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync {
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync if ( so->so_lport == lport
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync && so->so_laddr.s_addr == laddr.s_addr
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync && so->so_faddr.s_addr == faddr.s_addr
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync && so->so_fport == fport)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return so;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return (struct socket *)NULL;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Create a new socket, initialise the fields
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * It is the responsibility of the caller to
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * insque() it into the correct linked-list
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstruct socket *
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsocreate()
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct socket *so;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so = (struct socket *)malloc(sizeof(struct socket));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if(so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync memset(so, 0, sizeof(struct socket));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state = SS_NOFDREF;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->s = -1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return so;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * remque and free a socket, clobber cache
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsofree(PNATState pData, struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so == tcp_last_so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync tcp_last_so = &tcb;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else if (so == udp_last_so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync udp_last_so = &udb;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m_free(pData, so->so_m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if(so->so_next && so->so_prev)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync remque(pData, so); /* crashes if so is not in a queue */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync free(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Read from so's socket into sb_snd, updating all relevant sbuf fields
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * NOTE: This will only be called if it is select()ed for reading, so
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * a read() of 0 (or less) means it's disconnected
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncint
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsoread(PNATState pData, struct socket *so, int fCloseIfNothingRead)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int n, nn, lss, total;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct sbuf *sb = &so->so_snd;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync size_t len = sb->sb_datalen - sb->sb_cc;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct iovec iov[2];
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int mss = so->so_tcpcb->t_maxseg;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_CALL("soread");
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("so = %lx", (long )so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * No need to check if there's enough room to read.
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * soread wouldn't have been called if there weren't
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len = sb->sb_datalen - sb->sb_cc;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_base = sb->sb_wptr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_base = 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_len = 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (sb->sb_wptr < sb->sb_rptr)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len = sb->sb_rptr - sb->sb_wptr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Should never succeed, but... */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (iov[0].iov_len > len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len = len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (iov[0].iov_len > mss)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len -= iov[0].iov_len%mss;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
11b175175a0ed424b8e8354acda681ad0adde0f8vboxsync {
11b175175a0ed424b8e8354acda681ad0adde0f8vboxsync iov[0].iov_len = (sb->sb_data + sb->sb_datalen) - sb->sb_wptr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Should never succeed, but... */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (iov[0].iov_len > len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len = len;
11b175175a0ed424b8e8354acda681ad0adde0f8vboxsync len -= iov[0].iov_len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_base = sb->sb_data;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_len = sb->sb_rptr - sb->sb_data;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if(iov[1].iov_len > len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_len = len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync total = iov[0].iov_len + iov[1].iov_len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (total > mss)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync lss = total % mss;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (iov[1].iov_len > lss)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_len -= lss;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = 2;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync lss -= iov[1].iov_len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len -= lss;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = 2;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (iov[0].iov_len > mss)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len -= iov[0].iov_len%mss;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifdef HAVE_READV
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync nn = readv(so->s, (struct iovec *)iov, n);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " ... read nn = %d bytes\n", nn));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync nn = recv(so->s, iov[0].iov_base, iov[0].iov_len,0);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (nn <= 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if defined(VBOX_WITH_SIMPLIFIED_SLIRP_SYNC) && defined(RT_OS_WINDOWS)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Special case for WSAEnumNetworkEvents: If we receive 0 bytes that
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * _could_ mean that the connection is closed. But we will receive an
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * FD_CLOSE event later if the connection was _really_ closed. With
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * www.youtube.com I see this very often. Closing the socket too early
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * would be dangerous.
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (nn == 0 && !fCloseIfNothingRead)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (nn < 0 && (errno == EINTR || errno == EAGAIN || errno == EWOULDBLOCK))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* nn == 0 means peer has performed an orderly shutdown */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " --- soread() disconnected, nn = %d, errno = %d-%s\n",
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync nn, errno,strerror(errno)));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sofcantrcvmore(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync tcp_sockclosed(pData, sototcpcb(so));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return -1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifndef HAVE_READV
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * If there was no error, try and read the second time round
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * We read again if n = 2 (ie, there's another part of the buffer)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * and we read as much as we could in the first read
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * We don't test for <= 0 this time, because there legitimately
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * might not be any more data (since the socket is non-blocking),
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * a close will be detected on next iteration.
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * A return of -1 wont (shouldn't) happen, since it didn't happen above
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (n == 2 && nn == iov[0].iov_len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int ret;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ret = recv(so->s, iov[1].iov_base, iov[1].iov_len,0);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (ret > 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync nn += ret;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " ... read nn = %d bytes\n", nn));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Update fields */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_cc += nn;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_wptr += nn;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (sb->sb_wptr >= (sb->sb_data + sb->sb_datalen))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_wptr -= sb->sb_datalen;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return nn;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Get urgent data
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync *
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * When the socket is created, we set it SO_OOBINLINE,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * so when OOB data arrives, we soread() it and everything
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * in the send buffer is sent as urgent data
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsorecvoob(PNATState pData, struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct tcpcb *tp = sototcpcb(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_CALL("sorecvoob");
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("so = %lx", (long)so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * We take a guess at how much urgent data has arrived.
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * In most situations, when urgent data arrives, the next
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * read() should get all the urgent data. This guess will
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * be wrong however if more data arrives just after the
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * urgent data, or the read() doesn't return all the
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * urgent data.
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync soread(pData, so, /*fCloseIfNothingRead=*/false);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync tp->snd_up = tp->snd_una + so->so_snd.sb_cc;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync tp->t_force = 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync tcp_output(pData, tp);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync tp->t_force = 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Send urgent data
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * There's a lot duplicated code here, but...
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncint
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsosendoob(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct sbuf *sb = &so->so_rcv;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync char buff[2048]; /* XXX Shouldn't be sending more oob data than this */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int n, len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_CALL("sosendoob");
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("so = %lx", (long)so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("sb->sb_cc = %d", sb->sb_cc);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_urgc > sizeof(buff))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_urgc = sizeof(buff); /* XXX */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (sb->sb_rptr < sb->sb_wptr)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* We can send it directly */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = send(so->s, sb->sb_rptr, so->so_urgc, (MSG_OOB)); /* |MSG_DONTWAIT)); */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_urgc -= n;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " --- sent %d bytes urgent data, %d urgent bytes left\n",
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n, so->so_urgc));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Since there's no sendv or sendtov like writev,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * we must copy all data to a linear buffer then
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * send it all
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len = (sb->sb_data + sb->sb_datalen) - sb->sb_rptr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (len > so->so_urgc)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len = so->so_urgc;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync memcpy(buff, sb->sb_rptr, len);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_urgc -= len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_urgc)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = sb->sb_wptr - sb->sb_data;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (n > so->so_urgc)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = so->so_urgc;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync memcpy(buff + len, sb->sb_data, n);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_urgc -= n;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len += n;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = send(so->s, buff, len, (MSG_OOB)); /* |MSG_DONTWAIT)); */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifdef DEBUG
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (n != len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ERROR((dfd, "Didn't send all data urgently XXXXX\n"));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " ---2 sent %d bytes urgent data, %d urgent bytes left\n",
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n, so->so_urgc));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_cc -= n;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_rptr += n;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (sb->sb_rptr >= (sb->sb_data + sb->sb_datalen))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_rptr -= sb->sb_datalen;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return n;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Write data from so_rcv to so's socket,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * updating all sbuf field as necessary
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncint
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsowrite(PNATState pData, struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int n,nn;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct sbuf *sb = &so->so_rcv;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync size_t len = sb->sb_cc;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct iovec iov[2];
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_CALL("sowrite");
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("so = %lx", (long)so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_urgc)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sosendoob(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (sb->sb_cc == 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * No need to check if there's something to write,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * sowrite wouldn't have been called otherwise
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len = sb->sb_cc;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_base = sb->sb_rptr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_base = 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_len = 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (sb->sb_rptr < sb->sb_wptr)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len = sb->sb_wptr - sb->sb_rptr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Should never succeed, but... */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (iov[0].iov_len > len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len = len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len = (sb->sb_data + sb->sb_datalen) - sb->sb_rptr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (iov[0].iov_len > len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[0].iov_len = len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len -= iov[0].iov_len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_base = sb->sb_data;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_len = sb->sb_wptr - sb->sb_data;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (iov[1].iov_len > len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync iov[1].iov_len = len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = 2;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Check if there's urgent data to send, and if so, send it */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifdef HAVE_READV
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync nn = writev(so->s, (const struct iovec *)iov, n);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " ... wrote nn = %d bytes\n", nn));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync nn = send(so->s, iov[0].iov_base, iov[0].iov_len, 0);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* This should never happen, but people tell me it does *shrug* */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (nn < 0 && (errno == EAGAIN || errno == EINTR || errno == EWOULDBLOCK))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (nn < 0 || (nn == 0 && iov[0].iov_len > 0))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " --- sowrite disconnected, so->so_state = %x, errno = %d\n",
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state, errno));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sofcantsendmore(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync tcp_sockclosed(pData, sototcpcb(so));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return -1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifndef HAVE_READV
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (n == 2 && nn == iov[0].iov_len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int ret;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ret = send(so->s, iov[1].iov_base, iov[1].iov_len,0);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (ret > 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync nn += ret;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync DEBUG_MISC((dfd, " ... wrote nn = %d bytes\n", nn));
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Update sbuf */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_cc -= nn;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_rptr += nn;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (sb->sb_rptr >= (sb->sb_data + sb->sb_datalen))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sb->sb_rptr -= sb->sb_datalen;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * If in DRAIN mode, and there's no more data, set
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * it CANTSENDMORE
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if ((so->so_state & SS_FWDRAIN) && sb->sb_cc == 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sofcantsendmore(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return nn;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * recvfrom() a UDP socket
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsorecvfrom(PNATState pData, struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct sockaddr_in addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync socklen_t addrlen = sizeof(struct sockaddr_in);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_CALL("sorecvfrom");
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("so = %lx", (long)so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_type == IPPROTO_ICMP)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* This is a "ping" reply */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if !defined(VBOX_WITH_SLIRP_ICMP) || (defined(VBOX_WITH_SLIRP_ICMP) && !defined(RT_OS_WINDOWS))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sorecvfrom_icmp_unix(pData, so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if defined(VBOX_WITH_SLIRP_ICMP) && defined(RT_OS_WINDOWS)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sorecvfrom_icmp_win(pData, so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync udp_detach(pData, so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* A "normal" UDP packet */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct mbuf *m;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync size_t len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync u_long n;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (!(m = m_get(pData)))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m->m_data += if_maxlinkhdr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * XXX Shouldn't FIONREAD packets destined for port 53,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * but I don't know the max packet size for DNS lookups
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len = M_FREEROOM(m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* if (so->so_fport != htons(53)) */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ioctlsocket(so->s, FIONREAD, &n);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (n > len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync n = (m->m_data - m->m_dat) + m->m_len + n + 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m_inc(m, n);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len = M_FREEROOM(m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m->m_len = recvfrom(so->s, m->m_data, len, 0,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync (struct sockaddr *)&addr, &addrlen);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " did recvfrom %d, errno = %d-%s\n",
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m->m_len, errno,strerror(errno)));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if(m->m_len < 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync u_char code = ICMP_UNREACH_PORT;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (errno == EHOSTUNREACH)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync code = ICMP_UNREACH_HOST;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else if(errno == ENETUNREACH)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync code = ICMP_UNREACH_NET;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd," rx error, tx icmp ICMP_UNREACH:%i\n", code));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icmp_error(pData, so->so_m, ICMP_UNREACH,code, 0,strerror(errno));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m_free(pData, m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Hack: domain name lookup will be used the most for UDP,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * and since they'll only be used once there's no need
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * for the 4 minute (or whatever) timeout... So we time them
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * out much quicker (10 seconds for now...)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_expire)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_fport == htons(53))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_expire = curtime + SO_EXPIREFAST;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_expire = curtime + SO_EXPIRE;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if 0
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (m->m_len == len)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m_inc(m, MINCSIZE);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m->m_len = 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * If this packet was destined for CTL_ADDR,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * make it look like that's where it came from, done by udp_output
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync udp_output(pData, so, m, &addr);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync } /* rx error */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync } /* if ping packet */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * sendto() a socket
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncint
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsosendto(PNATState pData, struct socket *so, struct mbuf *m)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int ret;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct sockaddr_in addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if 0
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct sockaddr_in host_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_CALL("sosendto");
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("so = %lx", (long)so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("m = %lx", (long)m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_family = AF_INET;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if ((so->so_faddr.s_addr & htonl(pData->netmask)) == special_addr.s_addr)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* It's an alias */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync uint32_t last_byte = ntohl(so->so_faddr.s_addr) & ~pData->netmask;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync switch(last_byte)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if 0
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* handle this case at 'default:' */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case CTL_BROADCAST:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_addr.s_addr = INADDR_BROADCAST;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Send the packet to host to fully emulate broadcast */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /** @todo r=klaus: on Linux host this causes the host to receive
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * the packet twice for some reason. And I cannot find any place
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * in the man pages which states that sending a broadcast does not
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * reach the host itself. */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync host_addr.sin_family = AF_INET;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync host_addr.sin_port = so->so_fport;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync host_addr.sin_addr = our_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sendto(so->s, m->m_data, m->m_len, 0,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync (struct sockaddr *)&host_addr, sizeof (struct sockaddr));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case CTL_DNS:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (!get_dns_addr(pData, &dns_addr))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_addr = dns_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_addr = loopback_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case CTL_ALIAS:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync default:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (last_byte == ~pData->netmask)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_addr.s_addr = INADDR_BROADCAST;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_addr = loopback_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_addr = so->so_faddr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_port = so->so_fport;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd, " sendto()ing, addr.sin_port=%d, addr.sin_addr.s_addr=%.16s\n",
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ntohs(addr.sin_port), inet_ntoa(addr.sin_addr)));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Don't care what port we get */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ret = sendto(so->s, m->m_data, m->m_len, 0,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync (struct sockaddr *)&addr, sizeof (struct sockaddr));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (ret < 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync LogRel(("UDP: sendto fails (%s)\n", strerror(errno)));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return -1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Kill the socket if there's no reply in 4 minutes,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * but only if it's an expirable socket
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_expire)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_expire = curtime + SO_EXPIRE;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state = SS_ISFCONNECTED; /* So that it gets select()ed */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * XXX This should really be tcp_listen
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstruct socket *
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsolisten(PNATState pData, u_int port, u_int32_t laddr, u_int lport, int flags)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct sockaddr_in addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct socket *so;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync socklen_t addrlen = sizeof(addr);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int s, opt = 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_CALL("solisten");
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("port = %d", port);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("laddr = %x", laddr);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("lport = %d", lport);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_ARG("flags = %x", flags);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if ((so = socreate()) == NULL)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* free(so); Not sofree() ??? free(NULL) == NOP */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return NULL;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Don't tcp_attach... we don't need so_snd nor so_rcv */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if ((so->so_tcpcb = tcp_newtcpcb(pData, so)) == NULL)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync free(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return NULL;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync insque(pData, so,&tcb);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * SS_FACCEPTONCE sockets must time out.
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync */
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync if (flags & SS_FACCEPTONCE)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_tcpcb->t_timer[TCPT_KEEP] = TCPTV_KEEP_INIT*2;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state = (SS_FACCEPTCONN|flags);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_lport = lport; /* Kept in network format */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_laddr.s_addr = laddr; /* Ditto */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_family = AF_INET;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_addr.s_addr = INADDR_ANY;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync addr.sin_port = port;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if ( ((s = socket(AF_INET,SOCK_STREAM,0)) < 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync || (setsockopt(s,SOL_SOCKET,SO_REUSEADDR,(char *)&opt,sizeof(int)) < 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync || (bind(s,(struct sockaddr *)&addr, sizeof(addr)) < 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync || (listen(s,1) < 0))
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifdef RT_OS_WINDOWS
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int tmperrno = WSAGetLastError(); /* Don't clobber the real reason we failed */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync closesocket(s);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sofree(pData, so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Restore the real errno */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync WSASetLastError(tmperrno);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int tmperrno = errno; /* Don't clobber the real reason we failed */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync close(s);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sofree(pData, so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Restore the real errno */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync errno = tmperrno;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return NULL;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync setsockopt(s,SOL_SOCKET,SO_OOBINLINE,(char *)&opt,sizeof(int));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync getsockname(s,(struct sockaddr *)&addr,&addrlen);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_fport = addr.sin_port;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (addr.sin_addr.s_addr == 0 || addr.sin_addr.s_addr == loopback_addr.s_addr)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_faddr = alias_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_faddr = addr.sin_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->s = s;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return so;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Data is available in so_rcv
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Just write() the data to the socket
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * XXX not yet...
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsorwakeup(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if 0
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sowrite(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync FD_CLR(so->s,&writefds);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Data has been freed in so_snd
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * We have room for a read() if we want to
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * For now, don't read, it'll be done in the main loop
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsowwakeup(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Various session state calls
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * XXX Should be #define's
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * The socket state stuff needs work, these often get call 2 or 3
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * times each when only 1 was needed
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsoisfconnecting(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state &= ~(SS_NOFDREF|SS_ISFCONNECTED|SS_FCANTRCVMORE|
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync SS_FCANTSENDMORE|SS_FWDRAIN);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state |= SS_ISFCONNECTING; /* Clobber other states */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsoisfconnected(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state &= ~(SS_ISFCONNECTING|SS_FWDRAIN|SS_NOFDREF);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state |= SS_ISFCONNECTED; /* Clobber other states */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsofcantrcvmore(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if ((so->so_state & SS_NOFDREF) == 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync shutdown(so->s,0);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state &= ~(SS_ISFCONNECTING);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_state & SS_FCANTSENDMORE)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state = SS_NOFDREF; /* Don't select it */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* XXX close() here as well? */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state |= SS_FCANTRCVMORE;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsofcantsendmore(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if ((so->so_state & SS_NOFDREF) == 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync shutdown(so->s, 1); /* send FIN to fhost */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state &= ~(SS_ISFCONNECTING);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_state & SS_FCANTRCVMORE)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state = SS_NOFDREF; /* as above */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state |= SS_FCANTSENDMORE;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsoisfdisconnected(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if 0
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state &= ~(SS_ISFCONNECTING|SS_ISFCONNECTED);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync close(so->s);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state = SS_ISFDISCONNECTED;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * XXX Do nothing ... ?
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync/*
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Set write drain mode
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync * Set CANTSENDMORE once all data has been write()n
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncvoid
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsofwdrain(struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so->so_rcv.sb_cc)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_state |= SS_FWDRAIN;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync sofcantsendmore(so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifdef VBOX_WITH_SLIRP_ICMP
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstatic void
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsend_icmp_to_guest(PNATState pData, char *buff, size_t len, struct socket *so, const struct sockaddr_in *addr)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct ip *ip;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync uint32_t dst,src;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync char ip_copy[256];
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct icmp *icp;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int old_ip_len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct mbuf *m;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct icmp_msg *icm;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync uint8_t proto;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip = (struct ip *)buff;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icp = (struct icmp *)((char *)ip + (ip->ip_hl << 2));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync LogRel(("ICMP:received msg(t:%d, c:%d)\n", icp->icmp_type, icp->icmp_code));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (icp->icmp_type != ICMP_ECHOREPLY && icp->icmp_type != ICMP_TIMXCEED)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (icp->icmp_type == ICMP_TIMXCEED)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip = &icp->icmp_ip;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icm = icmp_find_original_mbuf(pData, ip);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (icm == NULL)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync LogRel(("NAT: Can't find the corresponding packet for the received ICMP\n"));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m = icm->im_m;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync Assert(m != NULL);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync src = addr->sin_addr.s_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip = mtod(m, struct ip *);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync proto = ip->ip_p;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Now ip is pointing on header we've sent from guest */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (icp->icmp_type == ICMP_TIMXCEED)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync old_ip_len = (ip->ip_hl << 2) + 64;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync memcpy(ip_copy, ip, old_ip_len);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* source address from original IP packet*/
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync dst = ip->ip_src.s_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* overide ther tail of old packet */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync memcpy(m->m_data, buff, len);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m->m_len = len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip = mtod(m, struct ip *); /* ip is from mbuf we've overrided */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icp = (struct icmp *)((char *)ip + (ip->ip_hl << 2));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (icp->icmp_type == ICMP_TIMXCEED)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* according RFC 793 error messages required copy of initial IP header + 64 bit */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync memcpy(&icp->icmp_ip, ip_copy, old_ip_len);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_tos = ((ip->ip_tos & 0x1E) | 0xC0); /* high priority for errors */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* the low level expects fields to be in host format so let's convert them*/
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync NTOHS(ip->ip_len);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync NTOHS(ip->ip_off);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync NTOHS(ip->ip_id);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_src.s_addr = src;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_dst.s_addr = dst;
c10a6f0c7041e4d1ee50ad38425aab9d43c55522vboxsync icmp_reflect(pData, m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync LIST_REMOVE(icm, im_list);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* Don't call m_free here*/
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#if 0
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (icp->icmp_type == ICMP_TIMXCEED)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync switch (proto)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case IPPROTO_UDP:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*XXX: so->so_m already freed so we shouldn't call sofree */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (so == udp_last_so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync udp_last_so = &udb;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync closesocket(icm->im_so->s);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icm->im_so->s = 1;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icm->im_so->so_state = SS_NOFDREF;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if(so->so_next && so->so_prev) {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync remque(pData, so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync free(icm->im_so);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case IPPROTO_TCP:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /*close tcp should be here */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync default:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* do nothing */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync free(icm);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync# ifdef RT_OS_WINDOWS
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstatic void
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncsorecvfrom_icmp_win(PNATState pData, struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int i;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct ip *ip;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct mbuf *m;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct icmp *icp;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct icmp_msg *icm;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct ip *ip_broken; /* ICMP returns header + 64 bit of packet */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync uint32_t src;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ICMP_ECHO_REPLY *icr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync u_char code = ~0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len = pData->pfIcmpParseReplies(pData->pvIcmpBuffer, pData->szIcmpBuffer);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (len < 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync LogRel(("NAT: Error (%d) occurred on ICMP receiving\n", GetLastError()));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (len == 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return; /* no error */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync LogRel(("IcmpParseReplies returns %ld\n", len));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icr = (ICMP_ECHO_REPLY *)pData->pvIcmpBuffer;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync for (i = 0; i < len; ++i)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync switch(icr[i].Status)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case IP_DEST_HOST_UNREACHABLE:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync code = (code != ~0 ? code : ICMP_UNREACH_HOST);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case IP_DEST_NET_UNREACHABLE:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync code = (code != ~0 ? code : ICMP_UNREACH_NET);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case IP_DEST_PROT_UNREACHABLE:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync code = (code != ~0 ? code : ICMP_UNREACH_PROTOCOL);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* UNREACH error inject here */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case IP_DEST_PORT_UNREACHABLE:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync code = (code != ~0 ? code : ICMP_UNREACH_PORT);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icmp_error(pData, so->so_m, ICMP_UNREACH, code, 0, "Error occurred!!!");
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case IP_SUCCESS: /* echo replied */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m = m_get(pData);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip = mtod(m, struct ip *);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_src.s_addr = icr[i].Address;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_p = IPPROTO_ICMP;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_dst.s_addr = so->so_laddr.s_addr; /*XXX: still the hack*/
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_hl = sizeof(struct ip) >> 2; /* requiered for icmp_reflect, no IP options */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_ttl = icr[i].Options.Ttl;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icp = (struct icmp *)&ip[1]; /* no options */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icp->icmp_type = ICMP_ECHOREPLY;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icp->icmp_code = 0;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icp->icmp_id = so->so_icmp_id;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icp->icmp_seq = so->so_icmp_seq;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync memcpy(icp->icmp_data, icr[i].Data, icr[i].DataSize);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_len = sizeof(struct ip) + ICMP_MINLEN + icr[i].DataSize;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m->m_len = ip->ip_len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icmp_reflect(pData, m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync case IP_TTL_EXPIRED_TRANSIT: /* TTL expired */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip_broken = icr[i].Data;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icm = icmp_find_original_mbuf(pData, ip_broken);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (icm == NULL) {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync LogRel(("ICMP: can't find original package (first double word %x)\n", *(uint32_t *)ip_broken));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync return;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync m = icm->im_m;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip = mtod(m, struct ip *);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_ttl = icr[i].Options.Ttl;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync src = ip->ip_src.s_addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_dst.s_addr = src;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip->ip_dst.s_addr = icr[i].Address;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icp = (struct icmp *)((char *)ip + (ip->ip_hl << 2));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync ip_broken->ip_src.s_addr = src; /*it packet sent from host not from guest*/
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync memcpy(icp->icmp_data, ip_broken, (ip_broken->ip_hl << 2) + 64);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icmp_reflect(pData, m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync default:
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync LogRel(("ICMP(default): message with Status: %x was received from %x\n", icr[i].Status, icr[i].Address));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync break;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync# endif /* RT_OS_WINDOWS */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif /* VBOX_WITH_SLIRP_ICMP */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsyncstatic void sorecvfrom_icmp_unix(PNATState pData, struct socket *so)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync{
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync struct sockaddr_in addr;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync socklen_t addrlen = sizeof(struct sockaddr_in);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync char buff[1500];
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync int len;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync len = recvfrom(so->s, buff, 1500, 0,
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync (struct sockaddr *)&addr, &addrlen);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync /* XXX Check if reply is "correct"? */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (len == -1 || len == 0)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync u_char code = ICMP_UNREACH_PORT;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync if (errno == EHOSTUNREACH)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync code = ICMP_UNREACH_HOST;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else if(errno == ENETUNREACH)
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync code = ICMP_UNREACH_NET;
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync DEBUG_MISC((dfd," udp icmp rx errno = %d-%s\n",
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync errno,strerror(errno)));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icmp_error(pData, so->so_m, ICMP_UNREACH,code, 0,strerror(errno));
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync {
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#ifdef VBOX_WITH_SLIRP_ICMP
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync send_icmp_to_guest(pData, buff, len, so, &addr);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#else
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync icmp_reflect(pData, so->so_m);
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync so->so_m = 0; /* Don't m_free() it again! */
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync#endif
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync }
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync}
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync
553a2f0d8ef91a6dad8de4eef206ff093af53a5dvboxsync