#ifdef _WIN32 /* wake me up inside */ #pragma GCC diagnostic ignored "-Wvla" /* emulated epoll, because the native async event system does not do * particularly well with notification */ #include "win32_upoll.h" #define uhash_slot(K, S) (((K) ^ (K >> 8)) & (S - 1)) static uhash_t* uhash_create(uint32_t size) { unsigned int i; size--; size |= size >> 1; size |= size >> 2; size |= size >> 4; size |= size >> 8; size |= size >> 16; size++; uhash_t* hash = (uhash_t*)calloc(1, sizeof(uhash_t) + size * sizeof(ulist_t)); hash->count = 0; hash->size = size; hash->items = (ulist_t*)(((char*)hash) + sizeof(uhash_t)); for(i = 0; i < size; i++) { ulist_init(&hash->items[i]); } return hash; } static void* uhash_lookup(uhash_t* hash, intptr_t key) { uint32_t slot = uhash_slot(key, hash->size); ulist_t* q; ulist_scan(q, &hash->items[slot]) { uitem_t* i = ulist_data(q, uitem_t, list); if(i->key == key) return i->val; } return NULL; } static void uhash_insert(uhash_t* hash, intptr_t key, void* val) { uint32_t slot = uhash_slot(key, hash->size); uitem_t* item = (uitem_t*)calloc(1, sizeof(uitem_t)); ulist_init(&item->list); item->key = key; item->val = val; ulist_append(&hash->items[slot], &item->list); } static int uhash_delete(uhash_t* hash, intptr_t key) { uint32_t slot = uhash_slot(key, hash->size); ulist_t* q; ulist_scan(q, &hash->items[slot]) { uitem_t* i = ulist_data(q, uitem_t, list); if(i->key == key) { ulist_remove(q); free(q); return 1; } } return 0; } static int uhash_destroy(uhash_t* hash) { int i; for(i = 0; i < hash->size; i++) { while(!ulist_empty(&hash->items[i])) { ulist_t* q = ulist_next(&hash->items[i]); uitem_t* n = ulist_data(q, uitem_t, list); ulist_remove(q); free(n); } } return 0; } upoll_t* upoll_create(uint32_t size) { assert(size > 0); upoll_t* upq = (upoll_t*)calloc(1, sizeof(upoll_t)); ulist_init(&upq->alive); upq->table = uhash_create(size); return upq; } void upoll_destroy(upoll_t* upq) { assert(upq != NULL); uhash_destroy(upq->table); ulist_t* q = NULL; unote_t* n = NULL; while(!ulist_empty(&upq->alive)) { q = ulist_next(&upq->alive); n = ulist_data(n, unote_t, queue); ulist_remove(q); free(n); } free(upq); } int upoll_ctl(upoll_t* upq, int op, intptr_t fd, upoll_event_t* event) { if(fd < 0) return -EBADF; unote_t* note = NULL; switch(op) { case UPOLL_CTL_ADD: { note = (unote_t*)uhash_lookup(upq->table, fd); if(!note) { note = (unote_t*)calloc(1, sizeof(unote_t)); note->upoll = upq; ulist_init(¬e->queue); note->event = *event; note->fd = fd; ulist_append(&upq->alive, ¬e->queue); uhash_insert(upq->table, fd, (void*)note); } break; } case UPOLL_CTL_DEL: { note = (unote_t*)uhash_lookup(upq->table, fd); if(!note) return -ENOENT; event = ¬e->event; ulist_remove(¬e->queue); uhash_delete(upq->table, fd); free(note); break; } case UPOLL_CTL_MOD: { note = (unote_t*)uhash_lookup(upq->table, fd); if(!note) return -ENOENT; note->event = *event; break; } default: { return -EINVAL; } } return 0; } #if defined(HAVE_POLL) int upoll_wait_poll(upoll_t* upq, upoll_event_t* evs, int nev, int timeout) { /* FD_SETSIZE should be smaller than OPEN_MAX, but OPEN_MAX isn't portable */ if(nev > FD_SETSIZE) nev = FD_SETSIZE; unote_t* nvec[nev]; int r, i, nfds = 0; uint32_t hint; struct pollfd pfds[nev]; unote_t* n = NULL; ulist_t* s = ulist_mark(&upq->alive); ulist_t* q = ulist_next(&upq->alive); while(q != s && nfds < nev) { n = ulist_data(q, unote_t, queue); q = ulist_next(q); ulist_remove(&n->queue); ulist_insert(&upq->alive, &n->queue); nvec[nfds] = n; pfds[nfds].events = 0; pfds[nfds].fd = n->fd; if(n->event.events & UPOLLIN) { pfds[nfds].events |= POLLIN; } if(n->event.events & UPOLLOUT) { pfds[nfds].events |= POLLOUT; } nfds++; } r = poll(pfds, nfds, timeout); if(r < 0) return -errno; int e = 0; for(i = 0; i < nfds && e < nev; i++) { hint = 0; if(pfds[i].revents) { n = nvec[i]; if(pfds[i].revents & POLLIN) hint |= UPOLLIN; if(pfds[i].revents & POLLOUT) hint |= UPOLLOUT; if(pfds[i].revents & (POLLERR | POLLNVAL | POLLHUP)) hint |= (UPOLLERR | UPOLLIN); if(hint & UPOLLERR) hint &= ~UPOLLOUT; evs[e].data = n->event.data; evs[e].events = hint; ++e; } } return e; } #else int upoll_wait_select(upoll_t* upq, upoll_event_t* evs, int nev, int timeout) { /* ok we need to test each file descriptor to see whether it is a real file * or a socket. select any file handles (they are always ready) */ if(nev > FD_SETSIZE) nev = FD_SETSIZE; unote_t* nvec[nev]; int i, maxfd = 0, e = 0, nfds = 0; fd_set pollin, pollout, pollerr; FD_ZERO(&pollin); FD_ZERO(&pollout); FD_ZERO(&pollerr); struct timeval tv; struct timeval* tvp = &tv; tv.tv_usec = 0; if(timeout < 0) { tvp = NULL; } else if(timeout == 0) tv.tv_sec = 0; else { tv.tv_sec = (timeout / 1000); tv.tv_usec = (timeout % 1000) * 1000; } unote_t* n = NULL; ulist_t* s = ulist_mark(&upq->alive); ulist_t* q = ulist_next(&upq->alive); while(q != s && nfds < nev) { n = ulist_data(q, unote_t, queue); q = ulist_next(q); ulist_remove(&n->queue); ulist_insert(&upq->alive, &n->queue); nvec[nfds] = n; if(n->event.events & UPOLLIN) { FD_SET((SOCKET)n->fd, &pollin); } if(n->event.events & UPOLLOUT) { FD_SET((SOCKET)n->fd, &pollout); } FD_SET((SOCKET)n->fd, &pollerr); if(maxfd < n->fd) maxfd = n->fd; nfds++; } #if defined(__WINDOWS__) int rc = select(0, &pollin, &pollout, &pollerr, tvp); if(rc == SOCKET_ERROR) { assert(WSAGetLastError() == WSAENOTSOCK); return -WSAGetLastError(); } #else int rc = select(maxfd + 1, &pollin, &pollout, &pollerr, tvp); if(rc == -1) { assert(errno == EINTR || errno == EBADF); return -errno; } #endif e = 0; for(i = 0; i < nfds && e < nev; i++) { uint32_t hint = 0; unote_t* n = nvec[i]; if(FD_ISSET(n->fd, &pollin)) { hint |= UPOLLIN; } if(FD_ISSET(n->fd, &pollerr)) { hint |= (UPOLLERR | UPOLLIN); } else if(FD_ISSET(n->fd, &pollout)) { hint |= UPOLLOUT; } if(hint) { evs[e].data = n->event.data; evs[e].events = hint; ++e; } } return e; } #endif int upoll_wait(upoll_t* upq, upoll_event_t* evs, int nev, int timeout) { int r = 0; #if defined(HAVE_POLL) r = upoll_wait_poll(upq, evs, nev, timeout); #else r = upoll_wait_select(upq, evs, nev, timeout); #endif return r; } intptr_t usocket(int domain, int type, int proto) { intptr_t fd = (intptr_t)socket(domain, type, proto); #if defined(__WINDOWS__) if(fd < 0) return -WSAGetLastError(); unsigned long flags = 1; int rc = ioctlsocket((SOCKET)fd, FIONBIO, &flags); if(rc < 0) return -WSAGetLastError(); #else if(fd < 0) return -errno; int rc = fcntl(fd, F_SETFL, fcntl(fd, F_GETFL, 0) | O_NONBLOCK); if(rc < 0) return -errno; #endif return fd; } int ubind(intptr_t fd, const char* host, const char* serv) { struct addrinfo* info; struct addrinfo hint; memset(&hint, 0, sizeof(hint)); int optval = 0; unsigned int optlen = sizeof(optval); #if defined(__WINDOWS__) int rc = getsockopt((SOCKET)fd, SOL_SOCKET, SO_TYPE, (char*)&optval, (int*)&optlen); #else int rc = getsockopt(fd, SOL_SOCKET, SO_TYPE, &optval, &optlen); #endif hint.ai_family = AF_INET; hint.ai_socktype = optval; rc = getaddrinfo(host, serv, &hint, &info); optval = 1; if(!rc) { #if defined(__WINDOWS__) rc = setsockopt((SOCKET)fd, SOL_SOCKET, SO_REUSEADDR, (char*)&optval, sizeof(optval)); #else rc = setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &optval, sizeof(optval)); #endif if(!rc) rc = bind(fd, info->ai_addr, info->ai_addrlen); } freeaddrinfo(info); if(rc) { #if defined(__WINDOWS__) return WSAGetLastError(); #else return errno; #endif } return 0; } int uconnect(intptr_t fd, const char* host, const char* serv) { struct addrinfo* info; struct addrinfo hint; memset(&hint, 0, sizeof(hint)); int optval = 0; unsigned int optlen; #if defined(__WINDOWS__) int rc = getsockopt(fd, SOL_SOCKET, SO_TYPE, (char*)&optval, (int*)&optlen); #else int rc = getsockopt(fd, SOL_SOCKET, SO_TYPE, &optval, &optlen); #endif hint.ai_family = AF_INET; hint.ai_socktype = optval; rc = getaddrinfo(host, serv, &hint, &info); if(!rc) { #if defined(__WINDOWS__) rc = connect((SOCKET)fd, info->ai_addr, info->ai_addrlen); #else rc = connect(fd, info->ai_addr, info->ai_addrlen); #endif } freeaddrinfo(info); if(rc) { #if defined(__WINDOWS__) if(WSAGetLastError() != WSAEWOULDBLOCK) return WSAGetLastError(); #else if(errno != EINPROGRESS) return errno; #endif } return 0; } int ulisten(intptr_t sock, int backlog) { return listen(sock, backlog); } intptr_t uaccept(intptr_t sock) { struct sockaddr addr; addr.sa_family = AF_INET; socklen_t addr_len; #if defined(__WINDOWS__) intptr_t fd = (intptr_t)accept((SOCKET)sock, &addr, &addr_len); if(fd == -1) return WSAGetLastError(); #else intptr_t fd = accept(sock, &addr, &addr_len); if(fd < 0) return errno; #endif return fd; } int uclose(intptr_t sock) { #if defined(__WINDOWS__) return closesocket((SOCKET)sock); #else return close(sock); #endif } int uread(intptr_t fd, char* buf, size_t len) { return recv(fd, buf, len, 0); } int uwrite(intptr_t fd, const char* buf, size_t len) { return send(fd, buf, len, 0); } /* adapted from (renamed make_overlapped to async for allergy reasons): */ /* socketpair.c Copyright 2007, 2010 by Nathan C. Myers Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met: Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer. Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution. The name of the author must not be used to endorse or promote products derived from this software without specific prior written permission. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ /* Changes: * 2014-02-12: merge David Woodhouse, Ger Hobbelt improvements * git.infradead.org/users/dwmw2/openconnect.git/commitdiff/bdeefa54 * github.com/GerHobbelt/selectable-socketpair * always init the socks[] to -1/INVALID_SOCKET on error, both on Win32/64 * and UNIX/other platforms * 2013-07-18: Change to BSD 3-clause license * 2010-03-31: * set addr to 127.0.0.1 because win32 getsockname does not always set it. * 2010-02-25: * set SO_REUSEADDR option to avoid leaking some windows resource. * Windows System Error 10049, "Event ID 4226 TCP/IP has reached * the security limit imposed on the number of concurrent TCP connect * attempts." Bleah. * 2007-04-25: * preserve value of WSAGetLastError() on all error returns. * 2007-04-22: (Thanks to Matthew Gregan ) * s/EINVAL/WSAEINVAL/ fix trivial compile failure * s/socket/WSASocket/ enable creation of sockets suitable as stdin/stdout * of a child process. * add argument make_overlapped */ #if defined(__WINDOWS__) int usocketpair(intptr_t socks[2], int async) { union { struct sockaddr_in inaddr; struct sockaddr addr; } a; SOCKET listener; int e; socklen_t addrlen = sizeof(a.inaddr); DWORD flags = (async ? WSA_FLAG_OVERLAPPED : 0); int reuse = 1; if(socks == 0) { WSASetLastError(WSAEINVAL); return SOCKET_ERROR; } socks[0] = socks[1] = -1; listener = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP); if(listener == INVALID_SOCKET) return SOCKET_ERROR; memset(&a, 0, sizeof(a)); a.inaddr.sin_family = AF_INET; a.inaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); a.inaddr.sin_port = 0; for(;;) { if(setsockopt(listener, SOL_SOCKET, SO_REUSEADDR, (char*)&reuse, (socklen_t)sizeof(reuse)) == -1) break; if(bind(listener, &a.addr, sizeof(a.inaddr)) == SOCKET_ERROR) break; memset(&a, 0, sizeof(a)); if(getsockname(listener, &a.addr, &addrlen) == SOCKET_ERROR) break; // win32 getsockname may only set the port number, p=0.0005. // ( http://msdn.microsoft.com/library/ms738543.aspx ): a.inaddr.sin_addr.s_addr = htonl(INADDR_LOOPBACK); a.inaddr.sin_family = AF_INET; if(listen(listener, 1) == SOCKET_ERROR) break; socks[0] = (intptr_t)WSASocket(AF_INET, SOCK_STREAM, 0, NULL, 0, flags); if(socks[0] == -1) break; if(connect((SOCKET)socks[0], &a.addr, sizeof(a.inaddr)) == SOCKET_ERROR) break; socks[1] = (intptr_t)accept(listener, NULL, NULL); if(socks[1] == -1) break; closesocket(listener); return 0; } e = WSAGetLastError(); closesocket(listener); closesocket((SOCKET)socks[0]); closesocket((SOCKET)socks[1]); WSASetLastError(e); socks[0] = socks[1] = -1; return SOCKET_ERROR; } #else int usocketpair(intptr_t socks[2], int dummy) { int sovec[2]; if(socks == 0) { errno = EINVAL; return -1; } dummy = socketpair(AF_LOCAL, SOCK_STREAM, 0, sovec); if(dummy) { socks[0] = socks[1] = -1; } else { socks[0] = sovec[0]; socks[1] = sovec[1]; } return dummy; } #endif #endif