#ifndef __WIN32__ # include # include # include # include # include #else # include # include #endif #include #include #include #include #include #include #define BUFSIZE 1000 #include "main.h" #include "net_multiplayer.h" #include "udp.h" #include "dns.h" static int getProto(char *str) { if( strstr(str, ".") != NULL )return PROTO_UDPv4; if( strstr(str, ":") != NULL )return PROTO_UDPv6; assert( ! "Protocol not detected !" ); return -1; } sock_udp_t *sock_udp_new(void) { sock_udp_t *new; new = malloc(sizeof(sock_udp_t)); memset(new, 0, sizeof(sock_udp_t)); return new; } void sock_udp_destroy(sock_udp_t *p) { assert(p != NULL); free(p); } sock_udp_t *sock_udp_bind(char *address, int port) { sock_udp_t *new; int res = -1; // no warninng assert(port > 0 && port < 65535); new = sock_udp_new(); new->proto = getProto(address); assert(new != NULL); if (new->proto == PROTO_UDPv4) { new->sock = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP); } #ifdef SUPPORT_IPv6 if (new->proto == PROTO_UDPv6) { new->sock = socket(AF_INET6, SOCK_DGRAM, IPPROTO_UDP); } #endif if (new->sock < 0) { fprintf(stderr, _("Unable to create socket when binding!\n")); sock_udp_destroy(new); #ifdef __WIN32__ WSACleanup(); #endif return NULL; } memset(&(new->sockAddr), 0, sizeof(new->sockAddr)); if (new->proto == PROTO_UDPv4) { new->sockAddr.sin_family = AF_INET; new->sockAddr.sin_port = htons(port); new->sockAddr.sin_addr.s_addr = inet_addr(address); res = bind(new->sock, (struct sockaddr *) &(new->sockAddr), sizeof(new->sockAddr)); } #ifdef SUPPORT_IPv6 if (new->proto == PROTO_UDPv6) { new->sockAddr6.sin6_family = AF_INET6; new->sockAddr6.sin6_port = htons(port); inet_pton(AF_INET6, address, &(new->sockAddr6.sin6_addr)); res = bind(new->sock, (struct sockaddr *) &(new->sockAddr6), sizeof(new->sockAddr6)); } #endif if (res < 0) { fprintf(stderr, _("Unable to set socket %s %d!\n"), address, port); sock_udp_destroy(new); #ifdef __WIN32__ WSACleanup(); #endif return NULL; } return new; } sock_udp_t *sock_udp_connect(char *address, int port) { sock_udp_t *new; assert(address != NULL); assert(port > 0 && port < 65536); new = sock_udp_new(); new->proto = getProto(address); assert(new != NULL); if (new->proto == PROTO_UDPv4) { new->sock = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP); } #ifdef SUPPORT_IPv6 if (new->proto == PROTO_UDPv6) { new->sock = socket(AF_INET6, SOCK_DGRAM, IPPROTO_UDP); } #endif if (new->sock < 0) { fprintf(stderr, _("Unable to create socket when connecting!\n")); sock_udp_destroy(new); #ifdef __WIN32__ WSACleanup(); #endif return NULL; } char *domain = gns_resolv (address); if (domain) address = domain; memset(&(new->sockAddr), 0, sizeof(new->sockAddr)); if (new->proto == PROTO_UDPv4) { new->sockAddr.sin_family = AF_INET; new->sockAddr.sin_port = htons(port); new->sockAddr.sin_addr.s_addr = inet_addr(address); } #ifdef SUPPORT_IPv6 if (new->proto == PROTO_UDPv6) { new->sockAddr6.sin6_family = AF_INET6; new->sockAddr6.sin6_port = htons(port); inet_pton(AF_INET6, address, &(new->sockAddr6.sin6_addr)); } #endif if (domain) free (domain); return new; } int sock_udp_set_non_block(sock_udp_t *p) { /* Set to nonblocking socket mode */ #ifndef __WIN32__ int oldFlag; oldFlag = fcntl(p->sock, F_GETFL, 0); if (fcntl(p->sock, F_SETFL, oldFlag | O_NONBLOCK) == -1) { return -1; } #else unsigned long arg = 1; // Operation is FIONBIO. Parameter is pointer on non-zero number. if (ioctlsocket(p->sock, FIONBIO, &arg) == SOCKET_ERROR) { WSACleanup(); return -1; } #endif return 0; } int sock_udp_read(sock_udp_t *src, sock_udp_t *dst, void *address, int len) { int addrlen; int size = -1; // no warninng assert(src != NULL); assert(dst != NULL); assert(address != NULL); if (src->proto == PROTO_UDPv4) { addrlen = sizeof(src->sockAddr); #ifndef __WIN32 size = recvfrom(src->sock, address, len, 0, (struct sockaddr *) &dst->sockAddr, (socklen_t *) & addrlen); #else size = recvfrom(src->sock, address, len, 0, (struct sockaddr *) &dst->sockAddr, (int *) &addrlen); #endif } #ifdef SUPPORT_IPv6 if (src->proto == PROTO_UDPv6) { addrlen = sizeof(src->sockAddr6); size = recvfrom(src->sock, address, len, 0, (struct sockaddr *) &dst->sockAddr6, (socklen_t *) & addrlen); } #endif dst->sock = src->sock; dst->proto = src->proto; if (size < 0) { char str_ip[STR_IP_SIZE]; sock_udp_get_ip(dst, str_ip, STR_IP_SIZE); fprintf(stderr, _("Unable to read form socket %d %s %d!\n"), size, str_ip, sock_udp_get_port(dst)); #ifdef __WIN32__ WSACleanup(); #endif return -1; } return size; } int sock_udp_write(sock_udp_t *src, sock_udp_t *dst, void *address, int len) { int addrlen; int size = -1; // no warninng assert(src != NULL); assert(dst != NULL); assert(address != NULL); if (src->proto == PROTO_UDPv4) { addrlen = sizeof(src->sockAddr); size = sendto(src->sock, address, len, 0, (struct sockaddr *) &dst->sockAddr, addrlen); } #ifdef SUPPORT_IPv6 if (src->proto == PROTO_UDPv6) { addrlen = sizeof(src->sockAddr6); size = sendto(src->sock, address, len, 0, (struct sockaddr *) &dst->sockAddr6, addrlen); } #endif if (size < 0) { char str_ip[STR_IP_SIZE]; sock_udp_get_ip(dst, str_ip, STR_IP_SIZE); fprintf(stderr, _("Unable to write on socket %d %s %d %d!\n"), size, str_ip, sock_udp_get_port(dst), dst->proto); //assert(0); #ifdef __WIN32__ WSACleanup(); #endif return -1; } return size; } void sock_udp_get_ip(sock_udp_t *p, char *str_ip, int len) { assert(p != NULL); assert(str_ip != NULL); if (p->proto == PROTO_UDPv4) { #ifndef __WIN32__ inet_ntop(AF_INET, &(p->sockAddr.sin_addr), str_ip, len); #else strcpy(str_ip, inet_ntoa(p->sockAddr.sin_addr)); //printf("strcpy(str_ip, inet_ntoa(p->sockAddr.sin_addr));\n"); #endif } #ifdef SUPPORT_IPv6 if (p->proto == PROTO_UDPv6) { inet_ntop(AF_INET6, &(p->sockAddr6.sin6_addr), str_ip, len); } #endif } int sock_udp_get_port(sock_udp_t *p) { assert(p != NULL); if (p->proto == PROTO_UDPv4) { return htons(p->sockAddr.sin_port); } #ifdef SUPPORT_IPv6 if (p->proto == PROTO_UDPv6) { return htons(p->sockAddr6.sin6_port); } #endif assert(!_("Bad IP proto!")); return -1; } void sock_udp_close(sock_udp_t *p) { assert(p != NULL); #ifndef __WIN32__ close(p->sock); #else closesocket(p->sock); //WSACleanup(); //kdyz ukoncime socket dobre neni treba cleanup #endif sock_udp_destroy(p); } #if 0 static int myWait(sock_udp_t *p) { fd_set readfds; fd_set errorfds; struct timeval tv; int max_fd; tv.tv_sec = 1; tv.tv_usec = 0; FD_ZERO(&readfds); FD_ZERO(&errorfds); max_fd = p->sock; FD_SET(p->sock, &readfds); FD_SET(p->sock, &errorfds); select(max_fd + 1, &readfds, (fd_set *) 0, &errorfds, &tv); if (FD_ISSET(p->sock, &readfds)) { FD_CLR(p->sock, &readfds); return 1; } return 0; } int main(int argc, char *argv[]) { sock_udp_t *sock; char buf[BUFSIZE]; int ret; if (strcmp(argv[1], "s") == 0) { sock_udp_t *cli; //sock = sock_udp_bind("::1", atoi(argv[2]), PROTO_UDPv6 ); sock = sock_udp_bind("127.0.0.1", atoi(argv[2]), PROTO_UDPv4); //cli = sock_udp_new(PROTO_UDPv6); cli = sock_udp_new(PROTO_UDPv4); while (1) { while (myWait(sock) == 0); memset(buf, 0, BUFSIZE); ret = sock_udp_read(sock, cli, buf, BUFSIZE); sock_udp_write(sock, cli, buf, ret); } } if (strcmp(argv[1], "c") == 0) { //sock = sock_udp_connect("::1", atoi(argv[2]), PROTO_UDPv6); sock = sock_udp_connect("127.0.0.1", atoi(argv[2]), PROTO_UDPv4); strcpy(buf, "Hello world !\n"); sock_udp_write(sock, sock, buf, strlen(buf)); memset(buf, 0, BUFSIZE); sock_udp_read(sock, sock, buf, BUFSIZE); printf("buf = %s", buf); //while(1)sleep(1); sock_udp_close(sock); } return 0; } #endif