| /* sim_sock.c: OS-dependent socket routines | |
| Copyright (c) 2001-2010, Robert M Supnik | |
| Permission is hereby granted, free of charge, to any person obtaining a | |
| copy of this software and associated documentation files (the "Software"), | |
| to deal in the Software without restriction, including without limitation | |
| the rights to use, copy, modify, merge, publish, distribute, sublicense, | |
| and/or sell copies of the Software, and to permit persons to whom the | |
| Software is furnished to do so, subject to the following conditions: | |
| The above copyright notice and this permission notice shall be included in | |
| all copies or substantial portions of the Software. | |
| THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
| IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
| FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
| ROBERT M SUPNIK BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER | |
| IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | |
| CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | |
| Except as contained in this notice, the name of Robert M Supnik shall not be | |
| used in advertising or otherwise to promote the sale, use or other dealings | |
| in this Software without prior written authorization from Robert M Supnik. | |
| 15-Oct-12 MP Added definitions needed to detect possible tcp | |
| connect failures | |
| 25-Sep-12 MP Reworked for RFC3493 interfaces supporting IPv6 and IPv4 | |
| 22-Jun-10 RMS Fixed types in sim_accept_conn (from Mark Pizzolato) | |
| 19-Nov-05 RMS Added conditional for OpenBSD (from Federico G. Schwindt) | |
| 16-Aug-05 RMS Fixed spurious SIGPIPE signal error in Unix | |
| 14-Apr-05 RMS Added WSAEINPROGRESS test (from Tim Riker) | |
| 09-Jan-04 RMS Fixed typing problem in Alpha Unix (found by Tim Chapman) | |
| 17-Apr-03 RMS Fixed non-implemented version of sim_close_sock | |
| (found by Mark Pizzolato) | |
| 17-Dec-02 RMS Added sim_connect_socket, sim_create_socket | |
| 08-Oct-02 RMS Revised for .NET compatibility | |
| 22-Aug-02 RMS Changed calling sequence for sim_accept_conn | |
| 22-May-02 RMS Added OS2 EMX support from Holger Veit | |
| 06-Feb-02 RMS Added VMS support from Robert Alan Byer | |
| 16-Sep-01 RMS Added Macintosh support from Peter Schorn | |
| 02-Sep-01 RMS Fixed UNIX bugs found by Mirian Lennox and Tom Markson | |
| */ | |
| #include "sim_defs.h" | |
| #include "sim_sock.h" | |
| #include <signal.h> | |
| #if defined(AF_INET6) && defined(_WIN32) | |
| #include <ws2tcpip.h> | |
| #endif | |
| #ifdef HAVE_DLOPEN | |
| #include <dlfcn.h> | |
| #endif | |
| #ifndef WSAAPI | |
| #define WSAAPI | |
| #endif | |
| #if defined(SHUT_RDWR) && !defined(SD_BOTH) | |
| #define SD_BOTH SHUT_RDWR | |
| #endif | |
| #ifndef NI_MAXHOST | |
| #define NI_MAXHOST 1025 | |
| #endif | |
| /* OS dependent routines | |
| sim_master_sock create master socket | |
| sim_accept_conn accept connection | |
| sim_read_sock read from socket | |
| sim_write_sock write from socket | |
| sim_close_sock close socket | |
| sim_setnonblock set socket non-blocking | |
| sim_msg_sock send message to socket | |
| */ | |
| /* First, all the non-implemented versions */ | |
| #if defined (__OS2__) && !defined (__EMX__) | |
| void sim_init_sock (void) | |
| { | |
| } | |
| void sim_cleanup_sock (void) | |
| { | |
| } | |
| SOCKET sim_master_sock (const char *hostport, t_stat *parse_status) | |
| { | |
| return INVALID_SOCKET; | |
| } | |
| SOCKET sim_connect_sock (const char *hostport, const char *default_host, const char *default_port) | |
| { | |
| return INVALID_SOCKET; | |
| } | |
| SOCKET sim_accept_conn (SOCKET master, char **connectaddr); | |
| { | |
| return INVALID_SOCKET; | |
| } | |
| int32 sim_read_sock (SOCKET sock, char *buf, int32 nbytes) | |
| { | |
| return -1; | |
| } | |
| int32 sim_write_sock (SOCKET sock, char *msg, int32 nbytes) | |
| { | |
| return 0; | |
| } | |
| void sim_close_sock (SOCKET sock, t_bool master) | |
| { | |
| return; | |
| } | |
| #else /* endif unimpl */ | |
| /* UNIX, Win32, Macintosh, VMS, OS2 (Berkeley socket) routines */ | |
| SOCKET sim_err_sock (SOCKET s, char *emsg, int32 flg) | |
| { | |
| int32 err = WSAGetLastError (); | |
| printf ("Sockets: %s error %d\n", emsg, err); | |
| sim_close_sock (s, flg); | |
| return INVALID_SOCKET; | |
| } | |
| typedef void (WSAAPI *freeaddrinfo_func) (struct addrinfo *ai); | |
| static freeaddrinfo_func p_freeaddrinfo; | |
| typedef int (WSAAPI *getaddrinfo_func) (const char *hostname, | |
| const char *service, | |
| const struct addrinfo *hints, | |
| struct addrinfo **res); | |
| static getaddrinfo_func p_getaddrinfo; | |
| #if defined(VMS) | |
| typedef size_t socklen_t; | |
| #if !defined(EAI_OVERFLOW) | |
| #define EAI_OVERFLOW EAI_FAIL | |
| #endif | |
| #endif | |
| typedef int (WSAAPI *getnameinfo_func) (const struct sockaddr *sa, socklen_t salen, char *host, size_t hostlen, char *serv, size_t servlen, int flags); | |
| static getnameinfo_func p_getnameinfo; | |
| static void WSAAPI s_freeaddrinfo (struct addrinfo *ai) | |
| { | |
| struct addrinfo *a, *an; | |
| for (a=ai; a != NULL; a=an) { | |
| an = a->ai_next; | |
| free (a->ai_canonname); | |
| free (a->ai_addr); | |
| free (a); | |
| } | |
| } | |
| static int WSAAPI s_getaddrinfo (const char *hostname, | |
| const char *service, | |
| const struct addrinfo *hints, | |
| struct addrinfo **res) | |
| { | |
| struct hostent *he; | |
| struct servent *se = NULL; | |
| struct sockaddr_in *sin; | |
| struct addrinfo *result = NULL; | |
| struct addrinfo *ai, *lai; | |
| struct addrinfo dhints; | |
| struct in_addr ipaddr; | |
| struct in_addr *fixed[2]; | |
| struct in_addr **ips = NULL; | |
| struct in_addr **ip; | |
| const char *cname = NULL; | |
| int port = 0; | |
| // Validate parameters | |
| if ((hostname == NULL) && (service == NULL)) | |
| return EAI_NONAME; | |
| if (hints) { | |
| if ((hints->ai_family != PF_INET) && (hints->ai_family != PF_UNSPEC)) | |
| return EAI_FAMILY; | |
| switch (hints->ai_socktype) | |
| { | |
| default: | |
| return EAI_SOCKTYPE; | |
| case SOCK_DGRAM: | |
| case SOCK_STREAM: | |
| case 0: | |
| break; | |
| } | |
| } | |
| else { | |
| hints = &dhints; | |
| memset(&dhints, 0, sizeof(dhints)); | |
| dhints.ai_family = PF_UNSPEC; | |
| } | |
| if (service) { | |
| char *c; | |
| port = strtoul(service, &c, 10); | |
| if ((port == 0) || (*c != '\0')) { | |
| switch (hints->ai_socktype) | |
| { | |
| case SOCK_DGRAM: | |
| se = getservbyname(service, "udp"); | |
| break; | |
| case SOCK_STREAM: | |
| case 0: | |
| se = getservbyname(service, "tcp"); | |
| break; | |
| } | |
| if (NULL == se) | |
| return EAI_SERVICE; | |
| port = se->s_port; | |
| } | |
| } | |
| if (hostname) { | |
| if ((0xffffffff != (ipaddr.s_addr = inet_addr(hostname))) || | |
| (0 == strcmp("255.255.255.255", hostname))) { | |
| fixed[0] = &ipaddr; | |
| fixed[1] = NULL; | |
| } | |
| else { | |
| if ((0xffffffff != (ipaddr.s_addr = inet_addr(hostname))) || | |
| (0 == strcmp("255.255.255.255", hostname))) { | |
| fixed[0] = &ipaddr; | |
| fixed[1] = NULL; | |
| if ((hints->ai_flags & AI_CANONNAME) && !(hints->ai_flags & AI_NUMERICHOST)) { | |
| he = gethostbyaddr((char *)&ipaddr, 4, AF_INET); | |
| if (NULL != he) | |
| cname = he->h_name; | |
| else | |
| cname = hostname; | |
| } | |
| ips = fixed; | |
| } | |
| else { | |
| if (hints->ai_flags & AI_NUMERICHOST) | |
| return EAI_NONAME; | |
| he = gethostbyname(hostname); | |
| if (he) { | |
| ips = (struct in_addr **)he->h_addr_list; | |
| if (hints->ai_flags & AI_CANONNAME) | |
| cname = he->h_name; | |
| } | |
| else { | |
| switch (h_errno) | |
| { | |
| case HOST_NOT_FOUND: | |
| case NO_DATA: | |
| return EAI_NONAME; | |
| case TRY_AGAIN: | |
| return EAI_AGAIN; | |
| default: | |
| return EAI_FAIL; | |
| } | |
| } | |
| } | |
| } | |
| } | |
| else { | |
| if (hints->ai_flags & AI_PASSIVE) | |
| ipaddr.s_addr = htonl(INADDR_ANY); | |
| else | |
| ipaddr.s_addr = htonl(INADDR_LOOPBACK); | |
| fixed[0] = &ipaddr; | |
| fixed[1] = NULL; | |
| ips = fixed; | |
| } | |
| for (ip=ips; *ip != NULL; ++ip) { | |
| ai = calloc(1, sizeof(*ai)); | |
| if (NULL == ai) { | |
| s_freeaddrinfo(result); | |
| return EAI_MEMORY; | |
| } | |
| ai->ai_family = PF_INET; | |
| ai->ai_socktype = hints->ai_socktype; | |
| ai->ai_protocol = hints->ai_protocol; | |
| ai->ai_addr = NULL; | |
| ai->ai_addrlen = sizeof(struct sockaddr_in); | |
| ai->ai_canonname = NULL; | |
| ai->ai_next = NULL; | |
| ai->ai_addr = calloc(1, sizeof(struct sockaddr_in)); | |
| if (NULL == ai->ai_addr) { | |
| free(ai); | |
| s_freeaddrinfo(result); | |
| return EAI_MEMORY; | |
| } | |
| sin = (struct sockaddr_in *)ai->ai_addr; | |
| sin->sin_family = PF_INET; | |
| sin->sin_port = port; | |
| memcpy(&sin->sin_addr, *ip, sizeof(sin->sin_addr)); | |
| if (NULL == result) | |
| result = ai; | |
| else | |
| lai->ai_next = ai; | |
| lai = ai; | |
| } | |
| if (cname) { | |
| result->ai_canonname = calloc(1, strlen(cname)+1); | |
| if (NULL == result->ai_canonname) { | |
| s_freeaddrinfo(result); | |
| return EAI_MEMORY; | |
| } | |
| strcpy(result->ai_canonname, cname); | |
| } | |
| *res = result; | |
| return 0; | |
| } | |
| #ifndef EAI_OVERFLOW | |
| #define EAI_OVERFLOW WSAENAMETOOLONG | |
| #endif | |
| static int WSAAPI s_getnameinfo (const struct sockaddr *sa, socklen_t salen, | |
| char *host, size_t hostlen, | |
| char *serv, size_t servlen, | |
| int flags) | |
| { | |
| struct hostent *he; | |
| struct servent *se = NULL; | |
| struct sockaddr_in *sin = (struct sockaddr_in *)sa; | |
| if (sin->sin_family != PF_INET) | |
| return EAI_FAMILY; | |
| if ((NULL == host) && (NULL == serv)) | |
| return EAI_NONAME; | |
| if ((serv) && (servlen > 0)) { | |
| if (flags & NI_NUMERICSERV) | |
| se = NULL; | |
| else | |
| if (flags & NI_DGRAM) | |
| se = getservbyport(sin->sin_port, "udp"); | |
| else | |
| se = getservbyport(sin->sin_port, "tcp"); | |
| if (se) { | |
| if (servlen <= strlen(se->s_name)) | |
| return EAI_OVERFLOW; | |
| strcpy(serv, se->s_name); | |
| } | |
| else { | |
| char buf[16]; | |
| sprintf(buf, "%d", ntohs(sin->sin_port)); | |
| if (servlen <= strlen(buf)) | |
| return EAI_OVERFLOW; | |
| strcpy(serv, buf); | |
| } | |
| } | |
| if ((host) && (hostlen > 0)) { | |
| if (flags & NI_NUMERICHOST) | |
| he = NULL; | |
| else | |
| he = gethostbyaddr((char *)&sin->sin_addr, 4, AF_INET); | |
| if (he) { | |
| if (hostlen < strlen(he->h_name)+1) | |
| return EAI_OVERFLOW; | |
| strcpy(host, he->h_name); | |
| } | |
| else { | |
| if (flags & NI_NAMEREQD) | |
| return EAI_NONAME; | |
| if (hostlen < strlen(inet_ntoa(sin->sin_addr))+1) | |
| return EAI_OVERFLOW; | |
| strcpy(host, inet_ntoa(sin->sin_addr)); | |
| } | |
| } | |
| return 0; | |
| } | |
| #if defined(_WIN32) || defined(__CYGWIN__) | |
| #if !defined(IPV6_V6ONLY) /* Older XP environments may not define IPV6_V6ONLY */ | |
| #define IPV6_V6ONLY 27 /* Treat wildcard bind as AF_INET6-only. */ | |
| #endif | |
| /* Dynamic DLL load variables */ | |
| #ifdef _WIN32 | |
| static HINSTANCE hLib = 0; /* handle to DLL */ | |
| #else | |
| static void *hLib = NULL; /* handle to Library */ | |
| #endif | |
| static int lib_loaded = 0; /* 0=not loaded, 1=loaded, 2=library load failed, 3=Func load failed */ | |
| static char* lib_name = "Ws2_32.dll"; | |
| /* load function pointer from DLL */ | |
| typedef int (*_func)(); | |
| static void load_function(char* function, _func* func_ptr) { | |
| #ifdef _WIN32 | |
| *func_ptr = (_func)GetProcAddress(hLib, function); | |
| #else | |
| *func_ptr = (_func)dlsym(hLib, function); | |
| #endif | |
| if (*func_ptr == 0) { | |
| char* msg = "Sockets: Failed to find function '%s' in %s\r\n"; | |
| printf (msg, function, lib_name); | |
| if (sim_log) fprintf (sim_log, msg, function, lib_name); | |
| lib_loaded = 3; | |
| } | |
| } | |
| /* load Ws2_32.dll as required */ | |
| int load_ws2(void) { | |
| switch(lib_loaded) { | |
| case 0: /* not loaded */ | |
| /* attempt to load DLL */ | |
| #ifdef _WIN32 | |
| hLib = LoadLibraryA(lib_name); | |
| #else | |
| hLib = dlopen(lib_name, RTLD_NOW); | |
| #endif | |
| if (hLib == 0) { | |
| /* failed to load DLL */ | |
| char* msg = "Sockets: Failed to load %s\r\n"; | |
| printf (msg, lib_name); | |
| if (sim_log) | |
| fprintf (sim_log, msg, lib_name); | |
| lib_loaded = 2; | |
| break; | |
| } else { | |
| /* library loaded OK */ | |
| lib_loaded = 1; | |
| } | |
| /* load required functions; sets dll_load=3 on error */ | |
| load_function("getaddrinfo", (_func *) &p_getaddrinfo); | |
| load_function("getnameinfo", (_func *) &p_getnameinfo); | |
| load_function("freeaddrinfo", (_func *) &p_freeaddrinfo); | |
| if (lib_loaded != 1) { | |
| /* unsuccessful load, connect stubs */ | |
| p_getaddrinfo = (getaddrinfo_func)s_getaddrinfo; | |
| p_getnameinfo = (getnameinfo_func)s_getnameinfo; | |
| p_freeaddrinfo = (freeaddrinfo_func)s_freeaddrinfo; | |
| } | |
| break; | |
| default: /* loaded or failed */ | |
| break; | |
| } | |
| return (lib_loaded == 1) ? 1 : 0; | |
| } | |
| #endif | |
| /* OS independent routines | |
| sim_parse_addr parse a hostname/ipaddress from port and apply defaults and | |
| optionally validate an address match | |
| */ | |
| /* sim_parse_addr host:port | |
| Presumption is that the input, if it doesn't contain a ':' character is a port specifier. | |
| If the host field contains one or more colon characters (i.e. it is an IPv6 address), | |
| the IPv6 address MUST be enclosed in square bracket characters (i.e. Domain Literal format) | |
| Inputs: | |
| cptr = pointer to input string | |
| default_host | |
| = optional pointer to default host if none specified | |
| host_len = length of host buffer | |
| default_port | |
| = optional pointer to default port if none specified | |
| port_len = length of port buffer | |
| validate_addr = optional name/addr which is checked to be equivalent | |
| to the host result of parsing the other input. This | |
| address would usually be returned by sim_accept_conn. | |
| Outputs: | |
| host = pointer to buffer for IP address (may be NULL), 0 = none | |
| port = pointer to buffer for IP port (may be NULL), 0 = none | |
| result = status (SCPE_OK on complete success or SCPE_ARG if | |
| parsing can't happen due to bad syntax, a value is | |
| out of range, a result can't fit into a result buffer, | |
| a service name doesn't exist, or a validation name | |
| doesn't match the parsed host) | |
| */ | |
| t_stat sim_parse_addr (const char *cptr, char *host, size_t host_len, const char *default_host, char *port, size_t port_len, const char *default_port, const char *validate_addr) | |
| { | |
| char gbuf[CBUFSIZE]; | |
| char *hostp, *portp; | |
| char *endc; | |
| unsigned long portval; | |
| if ((cptr == NULL) || (*cptr == 0)) | |
| return SCPE_ARG; | |
| if ((host != NULL) && (host_len != 0)) | |
| memset (host, 0, host_len); | |
| if ((port != NULL) && (port_len != 0)) | |
| memset (port, 0, port_len); | |
| gbuf[sizeof(gbuf)-1] = '\0'; | |
| strncpy (gbuf, cptr, sizeof(gbuf)-1); | |
| hostp = gbuf; /* default addr */ | |
| portp = NULL; | |
| if ((portp = strrchr (gbuf, ':')) && /* x:y? split */ | |
| (NULL == strchr (portp, ']'))) { | |
| *portp++ = 0; | |
| if (*portp == '\0') | |
| portp = (char *)default_port; | |
| } | |
| else { /* No colon in input */ | |
| portp = gbuf; /* Input is the port specifier */ | |
| hostp = (char *)default_host; /* host is defaulted if provided */ | |
| } | |
| if (portp != NULL) { | |
| portval = strtoul(portp, &endc, 10); | |
| if ((*endc == '\0') && ((portval == 0) || (portval > 65535))) | |
| return SCPE_ARG; /* numeric value too big */ | |
| if (*endc != '\0') { | |
| struct servent *se = getservbyname(portp, "tcp"); | |
| if (se == NULL) | |
| return SCPE_ARG; /* invalid service name */ | |
| } | |
| } | |
| if (port) /* port wanted? */ | |
| if (portp != NULL) { | |
| if (strlen(portp) >= port_len) | |
| return SCPE_ARG; /* no room */ | |
| else | |
| strcpy (port, portp); | |
| } | |
| if (hostp != NULL) { | |
| if (']' == hostp[strlen(hostp)-1]) { | |
| if ('[' != hostp[0]) | |
| return SCPE_ARG; /* invalid domain literal */ | |
| /* host may be the const default_host so move to temp buffer before modifying */ | |
| strncpy(gbuf, hostp+1, sizeof(gbuf)-1); /* remove brackets from domain literal host */ | |
| hostp = gbuf; | |
| hostp[strlen(hostp)-1] = '\0'; | |
| } | |
| } | |
| if (host) /* host wanted? */ | |
| if (hostp != NULL) { | |
| if (strlen(hostp) >= host_len) | |
| return SCPE_ARG; /* no room */ | |
| else | |
| strcpy (host, hostp); | |
| } | |
| if (validate_addr) { | |
| struct addrinfo *ai_host, *ai_validate, *ai; | |
| t_stat status; | |
| if (hostp == NULL) | |
| return SCPE_ARG; | |
| if (p_getaddrinfo(hostp, NULL, NULL, &ai_host)) | |
| return SCPE_ARG; | |
| if (p_getaddrinfo(validate_addr, NULL, NULL, &ai_validate)) { | |
| p_freeaddrinfo (ai_host); | |
| return SCPE_ARG; | |
| } | |
| status = SCPE_ARG; | |
| for (ai = ai_host; ai != NULL; ai = ai->ai_next) { | |
| if ((ai->ai_addrlen == ai_validate->ai_addrlen) && | |
| (ai->ai_family == ai_validate->ai_family) && | |
| (0 == memcmp (ai->ai_addr, ai_validate->ai_addr, ai->ai_addrlen))) { | |
| status = SCPE_OK; | |
| break; | |
| } | |
| } | |
| p_freeaddrinfo (ai_host); | |
| p_freeaddrinfo (ai_validate); | |
| return status; | |
| } | |
| return SCPE_OK; | |
| } | |
| void sim_init_sock (void) | |
| { | |
| #if defined (_WIN32) | |
| int err; | |
| WORD wVersionRequested; | |
| WSADATA wsaData; | |
| wVersionRequested = MAKEWORD (2, 2); | |
| err = WSAStartup (wVersionRequested, &wsaData); /* start Winsock */ | |
| if (err != 0) | |
| printf ("Winsock: startup error %d\n", err); | |
| #if defined(AF_INET6) | |
| load_ws2 (); | |
| #endif /* endif AF_INET6 */ | |
| #else /* Use native addrinfo APIs */ | |
| #if defined(AF_INET6) | |
| p_getaddrinfo = (getaddrinfo_func)getaddrinfo; | |
| p_getnameinfo = (getnameinfo_func)getnameinfo; | |
| p_freeaddrinfo = (freeaddrinfo_func)freeaddrinfo; | |
| #else | |
| /* Native APIs not available, connect stubs */ | |
| p_getaddrinfo = (getaddrinfo_func)s_getaddrinfo; | |
| p_getnameinfo = (getnameinfo_func)s_getnameinfo; | |
| p_freeaddrinfo = (freeaddrinfo_func)s_freeaddrinfo; | |
| #endif /* endif AF_INET6 */ | |
| #endif /* endif _WIN32 */ | |
| #if defined (SIGPIPE) | |
| signal (SIGPIPE, SIG_IGN); /* no pipe signals */ | |
| #endif | |
| } | |
| void sim_cleanup_sock (void) | |
| { | |
| #if defined (_WIN32) | |
| WSACleanup (); | |
| #endif | |
| } | |
| #if defined (_WIN32) /* Windows */ | |
| static int32 sim_setnonblock (SOCKET sock) | |
| { | |
| unsigned long non_block = 1; | |
| return ioctlsocket (sock, FIONBIO, &non_block); /* set nonblocking */ | |
| } | |
| #elif defined (VMS) /* VMS */ | |
| static int32 sim_setnonblock (SOCKET sock) | |
| { | |
| int non_block = 1; | |
| return ioctl (sock, FIONBIO, &non_block); /* set nonblocking */ | |
| } | |
| #else /* Mac, Unix, OS/2 */ | |
| static int32 sim_setnonblock (SOCKET sock) | |
| { | |
| int32 fl, sta; | |
| fl = fcntl (sock, F_GETFL,0); /* get flags */ | |
| if (fl == -1) | |
| return SOCKET_ERROR; | |
| sta = fcntl (sock, F_SETFL, fl | O_NONBLOCK); /* set nonblock */ | |
| if (sta == -1) | |
| return SOCKET_ERROR; | |
| #if !defined (macintosh) && !defined (__EMX__) /* Unix only */ | |
| sta = fcntl (sock, F_SETOWN, getpid()); /* set ownership */ | |
| if (sta == -1) | |
| return SOCKET_ERROR; | |
| #endif | |
| return 0; | |
| } | |
| #endif /* endif !Win32 && !VMS */ | |
| static SOCKET sim_create_sock (int af) | |
| { | |
| SOCKET newsock; | |
| int32 err; | |
| newsock = socket (af, SOCK_STREAM, 0); /* create socket */ | |
| if (newsock == INVALID_SOCKET) { /* socket error? */ | |
| err = WSAGetLastError (); | |
| printf ("Sockets: socket error %d\n", err); | |
| return INVALID_SOCKET; | |
| } | |
| return newsock; | |
| } | |
| /* | |
| Some platforms and/or network stacks have varying support for listening on | |
| an IPv6 socket and receiving connections from both IPv4 and IPv6 client | |
| connections. This is known as IPv4-Mapped. Some platforms claim such | |
| support (i.e. some Windows versions), but it doesn't work in all cases. | |
| */ | |
| SOCKET sim_master_sock (const char *hostport, t_stat *parse_status) | |
| { | |
| SOCKET newsock = INVALID_SOCKET; | |
| int32 sta; | |
| char host[CBUFSIZE], port[CBUFSIZE]; | |
| t_stat r; | |
| struct addrinfo hints; | |
| struct addrinfo *result = NULL, *preferred; | |
| r = sim_parse_addr (hostport, host, sizeof(host), NULL, port, sizeof(port), NULL, NULL); | |
| if (parse_status) | |
| *parse_status = r; | |
| if (r != SCPE_OK) | |
| return newsock; | |
| memset(&hints, 0, sizeof(hints)); | |
| hints.ai_flags = AI_PASSIVE; | |
| hints.ai_family = AF_UNSPEC; | |
| hints.ai_protocol = IPPROTO_TCP; | |
| hints.ai_socktype = SOCK_STREAM; | |
| if (p_getaddrinfo(host[0] ? host : NULL, port[0] ? port : NULL, &hints, &result)) { | |
| if (parse_status) | |
| *parse_status = SCPE_ARG; | |
| return newsock; | |
| } | |
| preferred = result; | |
| #ifdef IPV6_V6ONLY | |
| /* | |
| When we can create a dual stack socket, be sure to find the IPv6 addrinfo | |
| to bind to. | |
| */ | |
| for (; preferred != NULL; preferred = preferred->ai_next) { | |
| if (preferred->ai_family == AF_INET6) | |
| break; | |
| } | |
| if (preferred == NULL) | |
| preferred = result; | |
| #endif | |
| newsock = sim_create_sock (preferred->ai_family); /* create socket */ | |
| if (newsock == INVALID_SOCKET) { /* socket error? */ | |
| p_freeaddrinfo(result); | |
| return newsock; | |
| } | |
| #ifdef IPV6_V6ONLY | |
| if (preferred->ai_family == AF_INET6) { | |
| int off = FALSE; | |
| sta = setsockopt (newsock, IPPROTO_IPV6, IPV6_V6ONLY, (char *)&off, sizeof(off)); | |
| } | |
| #endif | |
| sta = bind (newsock, preferred->ai_addr, preferred->ai_addrlen); | |
| p_freeaddrinfo(result); | |
| if (sta == SOCKET_ERROR) /* bind error? */ | |
| return sim_err_sock (newsock, "bind", 1); | |
| sta = sim_setnonblock (newsock); /* set nonblocking */ | |
| if (sta == SOCKET_ERROR) /* fcntl error? */ | |
| return sim_err_sock (newsock, "fcntl", 1); | |
| sta = listen (newsock, 1); /* listen on socket */ | |
| if (sta == SOCKET_ERROR) /* listen error? */ | |
| return sim_err_sock (newsock, "listen", 1); | |
| return newsock; /* got it! */ | |
| } | |
| SOCKET sim_connect_sock (const char *hostport, const char *default_host, const char *default_port) | |
| { | |
| SOCKET newsock = INVALID_SOCKET; | |
| int32 sta; | |
| char host[CBUFSIZE], port[CBUFSIZE]; | |
| t_stat r; | |
| struct addrinfo hints; | |
| struct addrinfo *result = NULL; | |
| r = sim_parse_addr (hostport, host, sizeof(host), default_host, port, sizeof(port), default_port, NULL); | |
| if (r != SCPE_OK) | |
| return newsock; | |
| memset(&hints, 0, sizeof(hints)); | |
| hints.ai_family = AF_UNSPEC; | |
| hints.ai_protocol = IPPROTO_TCP; | |
| hints.ai_socktype = SOCK_STREAM; | |
| if (p_getaddrinfo(host[0] ? host : NULL, port[0] ? port : NULL, &hints, &result)) | |
| return newsock; | |
| newsock = sim_create_sock (result->ai_family); /* create socket */ | |
| if (newsock == INVALID_SOCKET) { /* socket error? */ | |
| p_freeaddrinfo (result); | |
| return newsock; | |
| } | |
| sta = sim_setnonblock (newsock); /* set nonblocking */ | |
| if (sta == SOCKET_ERROR) { /* fcntl error? */ | |
| p_freeaddrinfo (result); | |
| return sim_err_sock (newsock, "fcntl", 1); | |
| } | |
| sta = connect (newsock, result->ai_addr, result->ai_addrlen); | |
| p_freeaddrinfo (result); | |
| if ((sta == SOCKET_ERROR) && | |
| (WSAGetLastError () != WSAEWOULDBLOCK) && | |
| (WSAGetLastError () != WSAEINPROGRESS)) | |
| return sim_err_sock (newsock, "connect", 1); | |
| return newsock; /* got it! */ | |
| } | |
| SOCKET sim_accept_conn (SOCKET master, char **connectaddr) | |
| { | |
| int32 sta, err; | |
| #if defined (macintosh) || defined (__linux) || \ | |
| defined (__APPLE__) || defined (__OpenBSD__) || \ | |
| defined(__NetBSD__) || defined(__FreeBSD__) | |
| socklen_t size; | |
| #elif defined (_WIN32) || defined (__EMX__) || \ | |
| (defined (__ALPHA) && defined (__unix__)) | |
| int size; | |
| #else | |
| size_t size; | |
| #endif | |
| SOCKET newsock; | |
| struct sockaddr_storage clientname; | |
| if (master == 0) /* not attached? */ | |
| return INVALID_SOCKET; | |
| size = sizeof (clientname); | |
| memset (&clientname, 0, sizeof(clientname)); | |
| newsock = accept (master, (struct sockaddr *) &clientname, &size); | |
| if (newsock == INVALID_SOCKET) { /* error? */ | |
| err = WSAGetLastError (); | |
| if (err != WSAEWOULDBLOCK) | |
| printf ("Sockets: accept error %d\n", err); | |
| return INVALID_SOCKET; | |
| } | |
| if (connectaddr != NULL) { | |
| *connectaddr = calloc(1, NI_MAXHOST+1); | |
| #ifdef AF_INET6 | |
| p_getnameinfo((struct sockaddr *)&clientname, size, *connectaddr, NI_MAXHOST, NULL, 0, NI_NUMERICHOST); | |
| if (0 == memcmp("::ffff:", *connectaddr, 7)) /* is this a IPv4-mapped IPv6 address? */ | |
| strcpy(*connectaddr, 7+*connectaddr); /* prefer bare IPv4 address if possible */ | |
| #else | |
| strcpy(*connectaddr, inet_ntoa(((struct sockaddr_in *)&connectaddr)->s_addr)); | |
| #endif | |
| } | |
| sta = sim_setnonblock (newsock); /* set nonblocking */ | |
| if (sta == SOCKET_ERROR) /* fcntl error? */ | |
| return sim_err_sock (newsock, "fcntl", 0); | |
| return newsock; | |
| } | |
| int32 sim_check_conn (SOCKET sock, t_bool rd) | |
| { | |
| fd_set rw_set, er_set; | |
| fd_set *rw_p = &rw_set; | |
| fd_set *er_p = &er_set; | |
| struct timeval tz; | |
| timerclear (&tz); | |
| FD_ZERO (rw_p); | |
| FD_ZERO (er_p); | |
| FD_SET (sock, rw_p); | |
| FD_SET (sock, er_p); | |
| if (rd) | |
| select ((int) sock + 1, rw_p, NULL, er_p, &tz); | |
| else select ((int) sock + 1, NULL, rw_p, er_p, &tz); | |
| if (FD_ISSET (sock, rw_p)) | |
| return 1; | |
| if (FD_ISSET (sock, er_p)) | |
| return -1; | |
| return 0; | |
| } | |
| int32 sim_read_sock (SOCKET sock, char *buf, int32 nbytes) | |
| { | |
| int32 rbytes, err; | |
| rbytes = recv (sock, buf, nbytes, 0); | |
| if (rbytes == 0) /* disconnect */ | |
| return -1; | |
| if (rbytes == SOCKET_ERROR) { | |
| err = WSAGetLastError (); | |
| if (err == WSAEWOULDBLOCK) /* no data */ | |
| return 0; | |
| if ((err != WSAETIMEDOUT) && /* expected errors after a connect failure */ | |
| (err != WSAEHOSTUNREACH) && | |
| (err != WSAECONNREFUSED)) | |
| printf ("Sockets: read error %d\n", err); | |
| return -1; | |
| } | |
| return rbytes; | |
| } | |
| int32 sim_write_sock (SOCKET sock, char *msg, int32 nbytes) | |
| { | |
| return send (sock, msg, nbytes, 0); | |
| } | |
| void sim_close_sock (SOCKET sock, t_bool master) | |
| { | |
| shutdown(sock, SD_BOTH); | |
| closesocket (sock); | |
| } | |
| #endif /* end else !implemented */ |