swrap: Fix strict aliasing issues in swrap_pcap_packet_init()
[socket_wrapper.git] / src / socket_wrapper.c
index 3b0499d1756c19cba4388359e50874592a812b06..193f1f0672d2e0d883a4aeaaeba2fb29e238b1b4 100644 (file)
@@ -1,8 +1,11 @@
 /*
- * Copyright (c) 2005-2008 Jelmer Vernooij <jelmer@samba.org>
- * Copyright (C) 2006-2014 Stefan Metzmacher <metze@samba.org>
- * Copyright (C) 2013-2014 Andreas Schneider <asn@samba.org>
+ * BSD 3-Clause License
  *
+ * Copyright (c) 2005-2008, Jelmer Vernooij <jelmer@samba.org>
+ * Copyright (c) 2006-2018, Stefan Metzmacher <metze@samba.org>
+ * Copyright (c) 2013-2018, Andreas Schneider <asn@samba.org>
+ * Copyright (c) 2014-2017, Michael Adam <obnox@samba.org>
+ * Copyright (c) 2016-2018, Anoop C S <anoopcs@redhat.com>
  * All rights reserved.
  *
  * Redistribution and use in source and binary forms, with or without
@@ -31,7 +34,6 @@
  * 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.
- *
  */
 
 /*
@@ -79,6 +81,7 @@
 #ifdef HAVE_RPC_RPC_H
 #include <rpc/rpc.h>
 #endif
+#include <pthread.h>
 
 enum swrap_dbglvl_e {
        SWRAP_LOG_ERROR = 0,
@@ -94,12 +97,26 @@ enum swrap_dbglvl_e {
 #define PRINTF_ATTRIBUTE(a,b)
 #endif /* HAVE_FUNCTION_ATTRIBUTE_FORMAT */
 
+#ifdef HAVE_CONSTRUCTOR_ATTRIBUTE
+#define CONSTRUCTOR_ATTRIBUTE __attribute__ ((constructor))
+#else
+#define CONSTRUCTOR_ATTRIBUTE
+#endif /* HAVE_CONSTRUCTOR_ATTRIBUTE */
+
 #ifdef HAVE_DESTRUCTOR_ATTRIBUTE
 #define DESTRUCTOR_ATTRIBUTE __attribute__ ((destructor))
 #else
 #define DESTRUCTOR_ATTRIBUTE
 #endif
 
+#ifndef FALL_THROUGH
+# ifdef HAVE_FALLTHROUGH_ATTRIBUTE
+#  define FALL_THROUGH __attribute__ ((fallthrough))
+# else /* HAVE_FALLTHROUGH_ATTRIBUTE */
+#  define FALL_THROUGH ((void)0)
+# endif /* HAVE_FALLTHROUGH_ATTRIBUTE */
+#endif /* FALL_THROUGH */
+
 #ifdef HAVE_ADDRESS_SANITIZER_ATTRIBUTE
 #define DO_NOT_SANITIZE_ADDRESS_ATTRIBUTE __attribute__((no_sanitize_address))
 #else
@@ -127,6 +144,10 @@ enum swrap_dbglvl_e {
        } while(0)
 #endif
 
+#ifndef SAFE_FREE
+#define SAFE_FREE(x) do { if ((x) != NULL) {free(x); (x)=NULL;} } while(0)
+#endif
+
 #ifndef discard_const
 #define discard_const(ptr) ((void *)((uintptr_t)(ptr)))
 #endif
@@ -135,6 +156,8 @@ enum swrap_dbglvl_e {
 #define discard_const_p(type, ptr) ((type *)discard_const(ptr))
 #endif
 
+#define UNUSED(x) (void)(x)
+
 #ifdef IPV6_PKTINFO
 # ifndef IPV6_RECVPKTINFO
 #  define IPV6_RECVPKTINFO IPV6_PKTINFO
@@ -152,37 +175,25 @@ enum swrap_dbglvl_e {
 # endif
 #endif
 
+/* Add new global locks here please */
+# define SWRAP_LOCK_ALL \
+       swrap_mutex_lock(&libc_symbol_binding_mutex); \
 
-#define SWRAP_DLIST_ADD(list,item) do { \
-       if (!(list)) { \
-               (item)->prev    = NULL; \
-               (item)->next    = NULL; \
-               (list)          = (item); \
-       } else { \
-               (item)->prev    = NULL; \
-               (item)->next    = (list); \
-               (list)->prev    = (item); \
-               (list)          = (item); \
-       } \
-} while (0)
-
-#define SWRAP_DLIST_REMOVE(list,item) do { \
-       if ((list) == (item)) { \
-               (list)          = (item)->next; \
-               if (list) { \
-                       (list)->prev    = NULL; \
-               } \
-       } else { \
-               if ((item)->prev) { \
-                       (item)->prev->next      = (item)->next; \
-               } \
-               if ((item)->next) { \
-                       (item)->next->prev      = (item)->prev; \
-               } \
-       } \
-       (item)->prev    = NULL; \
-       (item)->next    = NULL; \
-} while (0)
+# define SWRAP_UNLOCK_ALL \
+       swrap_mutex_unlock(&libc_symbol_binding_mutex); \
+
+#define SOCKET_INFO_CONTAINER(si) \
+       (struct socket_info_container *)(si)
+
+#define SWRAP_LOCK_SI(si) do { \
+       struct socket_info_container *sic = SOCKET_INFO_CONTAINER(si); \
+       swrap_mutex_lock(&sic->meta.mutex); \
+} while(0)
+
+#define SWRAP_UNLOCK_SI(si) do { \
+       struct socket_info_container *sic = SOCKET_INFO_CONTAINER(si); \
+       swrap_mutex_unlock(&sic->meta.mutex); \
+} while(0)
 
 #if defined(HAVE_GETTIMEOFDAY_TZ) || defined(HAVE_GETTIMEOFDAY_TZ_VOID)
 #define swrapGetTimeOfDay(tval) gettimeofday(tval,NULL)
@@ -212,10 +223,19 @@ enum swrap_dbglvl_e {
 
 #define SOCKET_MAX_SOCKETS 1024
 
+/*
+ * Maximum number of socket_info structures that can
+ * be used. Can be overriden by the environment variable
+ * SOCKET_WRAPPER_MAX_SOCKETS.
+ */
+#define SOCKET_WRAPPER_MAX_SOCKETS_DEFAULT 65535
+
+#define SOCKET_WRAPPER_MAX_SOCKETS_LIMIT 262140
+
 /* This limit is to avoid broadcast sendto() needing to stat too many
  * files.  It may be raised (with a performance cost) to up to 254
  * without changing the format above */
-#define MAX_WRAPPED_INTERFACES 40
+#define MAX_WRAPPED_INTERFACES 64
 
 struct swrap_address {
        socklen_t sa_socklen;
@@ -230,15 +250,10 @@ struct swrap_address {
        } sa;
 };
 
-struct socket_info_fd {
-       struct socket_info_fd *prev, *next;
-       int fd;
-};
+int first_free;
 
 struct socket_info
 {
-       struct socket_info_fd *fds;
-
        int family;
        int type;
        int protocol;
@@ -261,24 +276,75 @@ struct socket_info
                unsigned long pck_snd;
                unsigned long pck_rcv;
        } io;
+};
 
-       struct socket_info *prev, *next;
+struct socket_info_meta
+{
+       unsigned int refcount;
+       int next_free;
+       pthread_mutex_t mutex;
 };
 
+struct socket_info_container
+{
+       struct socket_info info;
+       struct socket_info_meta meta;
+};
+
+static struct socket_info_container *sockets;
+
+static size_t socket_info_max = 0;
+
 /*
- * File descriptors are shared between threads so we should share socket
- * information too.
+ * Allocate the socket array always on the limit value. We want it to be
+ * at least bigger than the default so if we reach the limit we can
+ * still deal with duplicate fds pointing to the same socket_info.
  */
-struct socket_info *sockets;
+static size_t socket_fds_max = SOCKET_WRAPPER_MAX_SOCKETS_LIMIT;
+
+/* Hash table to map fds to corresponding socket_info index */
+static int *socket_fds_idx;
+
+/* Mutex to synchronize access to global libc.symbols */
+static pthread_mutex_t libc_symbol_binding_mutex = PTHREAD_MUTEX_INITIALIZER;
+
+/* Mutex for syncronizing port selection during swrap_auto_bind() */
+static pthread_mutex_t autobind_start_mutex;
+
+/* Mutex to guard the initialization of array of socket_info structures */
+static pthread_mutex_t sockets_mutex;
+
+/* Mutex to guard the socket reset in swrap_close() and swrap_remove_stale() */
+static pthread_mutex_t socket_reset_mutex;
+
+/* Mutex to synchronize access to first free index in socket_info array */
+static pthread_mutex_t first_free_mutex;
+
+/* Mutex to synchronize access to packet capture dump file */
+static pthread_mutex_t pcap_dump_mutex;
+
+/* Mutex for synchronizing mtu value fetch*/
+static pthread_mutex_t mtu_update_mutex;
 
 /* Function prototypes */
 
 bool socket_wrapper_enabled(void);
+
+void swrap_constructor(void) CONSTRUCTOR_ATTRIBUTE;
 void swrap_destructor(void) DESTRUCTOR_ATTRIBUTE;
 
-#ifdef NDEBUG
-# define SWRAP_LOG(...)
+#ifndef HAVE_GETPROGNAME
+static const char *getprogname(void)
+{
+#if defined(HAVE_PROGRAM_INVOCATION_SHORT_NAME)
+       return program_invocation_short_name;
+#elif defined(HAVE_GETEXECNAME)
+       return getexecname();
 #else
+       return NULL;
+#endif /* HAVE_PROGRAM_INVOCATION_SHORT_NAME */
+}
+#endif /* HAVE_GETPROGNAME */
 
 static void swrap_log(enum swrap_dbglvl_e dbglvl, const char *func, const char *format, ...) PRINTF_ATTRIBUTE(3, 4);
 # define SWRAP_LOG(dbglvl, ...) swrap_log((dbglvl), __func__, __VA_ARGS__)
@@ -291,42 +357,49 @@ static void swrap_log(enum swrap_dbglvl_e dbglvl,
        va_list va;
        const char *d;
        unsigned int lvl = 0;
+       const char *prefix = "SWRAP";
+       const char *progname = getprogname();
 
        d = getenv("SOCKET_WRAPPER_DEBUGLEVEL");
        if (d != NULL) {
                lvl = atoi(d);
        }
 
+       if (lvl < dbglvl) {
+               return;
+       }
+
        va_start(va, format);
        vsnprintf(buffer, sizeof(buffer), format, va);
        va_end(va);
 
-       if (lvl >= dbglvl) {
-               switch (dbglvl) {
-                       case SWRAP_LOG_ERROR:
-                               fprintf(stderr,
-                                       "SWRAP_ERROR(%d) - %s: %s\n",
-                                       (int)getpid(), func, buffer);
-                               break;
-                       case SWRAP_LOG_WARN:
-                               fprintf(stderr,
-                                       "SWRAP_WARN(%d) - %s: %s\n",
-                                       (int)getpid(), func, buffer);
-                               break;
-                       case SWRAP_LOG_DEBUG:
-                               fprintf(stderr,
-                                       "SWRAP_DEBUG(%d) - %s: %s\n",
-                                       (int)getpid(), func, buffer);
-                               break;
-                       case SWRAP_LOG_TRACE:
-                               fprintf(stderr,
-                                       "SWRAP_TRACE(%d) - %s: %s\n",
-                                       (int)getpid(), func, buffer);
-                               break;
-               }
+       switch (dbglvl) {
+               case SWRAP_LOG_ERROR:
+                       prefix = "SWRAP_ERROR";
+                       break;
+               case SWRAP_LOG_WARN:
+                       prefix = "SWRAP_WARN";
+                       break;
+               case SWRAP_LOG_DEBUG:
+                       prefix = "SWRAP_DEBUG";
+                       break;
+               case SWRAP_LOG_TRACE:
+                       prefix = "SWRAP_TRACE";
+                       break;
        }
+
+       if (progname == NULL) {
+               progname = "<unknown>";
+       }
+
+       fprintf(stderr,
+               "%s[%s (%u)] - %s: %s\n",
+               prefix,
+               progname,
+               (unsigned int)getpid(),
+               func,
+               buffer);
 }
-#endif
 
 /*********************************************************
  * SWRAP LOADING LIBC FUNCTIONS
@@ -334,90 +407,155 @@ static void swrap_log(enum swrap_dbglvl_e dbglvl,
 
 #include <dlfcn.h>
 
-struct swrap_libc_fns {
-       int (*libc_accept)(int sockfd,
-                          struct sockaddr *addr,
-                          socklen_t *addrlen);
-       int (*libc_bind)(int sockfd,
-                        const struct sockaddr *addr,
-                        socklen_t addrlen);
-       int (*libc_close)(int fd);
-       int (*libc_connect)(int sockfd,
-                           const struct sockaddr *addr,
-                           socklen_t addrlen);
-       int (*libc_dup)(int fd);
-       int (*libc_dup2)(int oldfd, int newfd);
-       int (*libc_fcntl)(int fd, int cmd, ...);
-       FILE *(*libc_fopen)(const char *name, const char *mode);
+#ifdef HAVE_ACCEPT4
+typedef int (*__libc_accept4)(int sockfd,
+                             struct sockaddr *addr,
+                             socklen_t *addrlen,
+                             int flags);
+#else
+typedef int (*__libc_accept)(int sockfd,
+                            struct sockaddr *addr,
+                            socklen_t *addrlen);
+#endif
+typedef int (*__libc_bind)(int sockfd,
+                          const struct sockaddr *addr,
+                          socklen_t addrlen);
+typedef int (*__libc_close)(int fd);
+typedef int (*__libc_connect)(int sockfd,
+                             const struct sockaddr *addr,
+                             socklen_t addrlen);
+typedef int (*__libc_dup)(int fd);
+typedef int (*__libc_dup2)(int oldfd, int newfd);
+typedef int (*__libc_fcntl)(int fd, int cmd, ...);
+typedef FILE *(*__libc_fopen)(const char *name, const char *mode);
+#ifdef HAVE_FOPEN64
+typedef FILE *(*__libc_fopen64)(const char *name, const char *mode);
+#endif
 #ifdef HAVE_EVENTFD
-       int (*libc_eventfd)(int count, int flags);
+typedef int (*__libc_eventfd)(int count, int flags);
 #endif
-       int (*libc_getpeername)(int sockfd,
-                               struct sockaddr *addr,
-                               socklen_t *addrlen);
-       int (*libc_getsockname)(int sockfd,
-                               struct sockaddr *addr,
-                               socklen_t *addrlen);
-       int (*libc_getsockopt)(int sockfd,
+typedef int (*__libc_getpeername)(int sockfd,
+                                 struct sockaddr *addr,
+                                 socklen_t *addrlen);
+typedef int (*__libc_getsockname)(int sockfd,
+                                 struct sockaddr *addr,
+                                 socklen_t *addrlen);
+typedef int (*__libc_getsockopt)(int sockfd,
                               int level,
                               int optname,
                               void *optval,
                               socklen_t *optlen);
-       int (*libc_ioctl)(int d, unsigned long int request, ...);
-       int (*libc_listen)(int sockfd, int backlog);
-       int (*libc_open)(const char *pathname, int flags, mode_t mode);
-       int (*libc_pipe)(int pipefd[2]);
-       int (*libc_read)(int fd, void *buf, size_t count);
-       ssize_t (*libc_readv)(int fd, const struct iovec *iov, int iovcnt);
-       int (*libc_recv)(int sockfd, void *buf, size_t len, int flags);
-       int (*libc_recvfrom)(int sockfd,
+typedef int (*__libc_ioctl)(int d, unsigned long int request, ...);
+typedef int (*__libc_listen)(int sockfd, int backlog);
+typedef int (*__libc_open)(const char *pathname, int flags, ...);
+#ifdef HAVE_OPEN64
+typedef int (*__libc_open64)(const char *pathname, int flags, ...);
+#endif /* HAVE_OPEN64 */
+typedef int (*__libc_openat)(int dirfd, const char *path, int flags, ...);
+typedef int (*__libc_pipe)(int pipefd[2]);
+typedef int (*__libc_read)(int fd, void *buf, size_t count);
+typedef ssize_t (*__libc_readv)(int fd, const struct iovec *iov, int iovcnt);
+typedef int (*__libc_recv)(int sockfd, void *buf, size_t len, int flags);
+typedef int (*__libc_recvfrom)(int sockfd,
                             void *buf,
                             size_t len,
                             int flags,
                             struct sockaddr *src_addr,
                             socklen_t *addrlen);
-       int (*libc_recvmsg)(int sockfd, const struct msghdr *msg, int flags);
-       int (*libc_send)(int sockfd, const void *buf, size_t len, int flags);
-       int (*libc_sendmsg)(int sockfd, const struct msghdr *msg, int flags);
-       int (*libc_sendto)(int sockfd,
+typedef int (*__libc_recvmsg)(int sockfd, const struct msghdr *msg, int flags);
+typedef int (*__libc_send)(int sockfd, const void *buf, size_t len, int flags);
+typedef int (*__libc_sendmsg)(int sockfd, const struct msghdr *msg, int flags);
+typedef int (*__libc_sendto)(int sockfd,
                           const void *buf,
                           size_t len,
                           int flags,
                           const  struct sockaddr *dst_addr,
                           socklen_t addrlen);
-       int (*libc_setsockopt)(int sockfd,
+typedef int (*__libc_setsockopt)(int sockfd,
                               int level,
                               int optname,
                               const void *optval,
                               socklen_t optlen);
 #ifdef HAVE_SIGNALFD
-       int (*libc_signalfd)(int fd, const sigset_t *mask, int flags);
+typedef int (*__libc_signalfd)(int fd, const sigset_t *mask, int flags);
+#endif
+typedef int (*__libc_socket)(int domain, int type, int protocol);
+typedef int (*__libc_socketpair)(int domain, int type, int protocol, int sv[2]);
+#ifdef HAVE_TIMERFD_CREATE
+typedef int (*__libc_timerfd_create)(int clockid, int flags);
+#endif
+typedef ssize_t (*__libc_write)(int fd, const void *buf, size_t count);
+typedef ssize_t (*__libc_writev)(int fd, const struct iovec *iov, int iovcnt);
+
+#define SWRAP_SYMBOL_ENTRY(i) \
+       union { \
+               __libc_##i f; \
+               void *obj; \
+       } _libc_##i
+
+struct swrap_libc_symbols {
+#ifdef HAVE_ACCEPT4
+       SWRAP_SYMBOL_ENTRY(accept4);
+#else
+       SWRAP_SYMBOL_ENTRY(accept);
+#endif
+       SWRAP_SYMBOL_ENTRY(bind);
+       SWRAP_SYMBOL_ENTRY(close);
+       SWRAP_SYMBOL_ENTRY(connect);
+       SWRAP_SYMBOL_ENTRY(dup);
+       SWRAP_SYMBOL_ENTRY(dup2);
+       SWRAP_SYMBOL_ENTRY(fcntl);
+       SWRAP_SYMBOL_ENTRY(fopen);
+#ifdef HAVE_FOPEN64
+       SWRAP_SYMBOL_ENTRY(fopen64);
+#endif
+#ifdef HAVE_EVENTFD
+       SWRAP_SYMBOL_ENTRY(eventfd);
+#endif
+       SWRAP_SYMBOL_ENTRY(getpeername);
+       SWRAP_SYMBOL_ENTRY(getsockname);
+       SWRAP_SYMBOL_ENTRY(getsockopt);
+       SWRAP_SYMBOL_ENTRY(ioctl);
+       SWRAP_SYMBOL_ENTRY(listen);
+       SWRAP_SYMBOL_ENTRY(open);
+#ifdef HAVE_OPEN64
+       SWRAP_SYMBOL_ENTRY(open64);
+#endif
+       SWRAP_SYMBOL_ENTRY(openat);
+       SWRAP_SYMBOL_ENTRY(pipe);
+       SWRAP_SYMBOL_ENTRY(read);
+       SWRAP_SYMBOL_ENTRY(readv);
+       SWRAP_SYMBOL_ENTRY(recv);
+       SWRAP_SYMBOL_ENTRY(recvfrom);
+       SWRAP_SYMBOL_ENTRY(recvmsg);
+       SWRAP_SYMBOL_ENTRY(send);
+       SWRAP_SYMBOL_ENTRY(sendmsg);
+       SWRAP_SYMBOL_ENTRY(sendto);
+       SWRAP_SYMBOL_ENTRY(setsockopt);
+#ifdef HAVE_SIGNALFD
+       SWRAP_SYMBOL_ENTRY(signalfd);
 #endif
-       int (*libc_socket)(int domain, int type, int protocol);
-       int (*libc_socketpair)(int domain, int type, int protocol, int sv[2]);
+       SWRAP_SYMBOL_ENTRY(socket);
+       SWRAP_SYMBOL_ENTRY(socketpair);
 #ifdef HAVE_TIMERFD_CREATE
-       int (*libc_timerfd_create)(int clockid, int flags);
+       SWRAP_SYMBOL_ENTRY(timerfd_create);
 #endif
-       ssize_t (*libc_write)(int fd, const void *buf, size_t count);
-       ssize_t (*libc_writev)(int fd, const struct iovec *iov, int iovcnt);
+       SWRAP_SYMBOL_ENTRY(write);
+       SWRAP_SYMBOL_ENTRY(writev);
 };
 
 struct swrap {
-       void *libc_handle;
-       void *libsocket_handle;
-
-       bool initialised;
-       bool enabled;
-
-       char *socket_dir;
-
-       struct swrap_libc_fns fns;
+       struct {
+               void *handle;
+               void *socket_handle;
+               struct swrap_libc_symbols symbols;
+       } libc;
 };
 
 static struct swrap swrap;
 
 /* prototypes */
-static const char *socket_wrapper_dir(void);
+static char *socket_wrapper_dir(void);
 
 #define LIBC_NAME "libc.so"
 
@@ -427,7 +565,6 @@ enum swrap_lib {
     SWRAP_LIBSOCKET,
 };
 
-#ifndef NDEBUG
 static const char *swrap_str_lib(enum swrap_lib lib)
 {
        switch (lib) {
@@ -442,7 +579,6 @@ static const char *swrap_str_lib(enum swrap_lib lib)
        /* Compiler would warn us about unhandled enum value if we get here */
        return "unknown";
 }
-#endif
 
 static void *swrap_load_lib_handle(enum swrap_lib lib)
 {
@@ -451,15 +587,32 @@ static void *swrap_load_lib_handle(enum swrap_lib lib)
        int i;
 
 #ifdef RTLD_DEEPBIND
-       flags |= RTLD_DEEPBIND;
+       const char *env_preload = getenv("LD_PRELOAD");
+       const char *env_deepbind = getenv("SOCKET_WRAPPER_DISABLE_DEEPBIND");
+       bool enable_deepbind = true;
+
+       /* Don't do a deepbind if we run with libasan */
+       if (env_preload != NULL && strlen(env_preload) < 1024) {
+               const char *p = strstr(env_preload, "libasan.so");
+               if (p != NULL) {
+                       enable_deepbind = false;
+               }
+       }
+
+       if (env_deepbind != NULL && strlen(env_deepbind) >= 1) {
+               enable_deepbind = false;
+       }
+
+       if (enable_deepbind) {
+               flags |= RTLD_DEEPBIND;
+       }
 #endif
 
        switch (lib) {
        case SWRAP_LIBNSL:
-               /* FALL TROUGH */
        case SWRAP_LIBSOCKET:
 #ifdef HAVE_LIBSOCKET
-               handle = swrap.libsocket_handle;
+               handle = swrap.libc.socket_handle;
                if (handle == NULL) {
                        for (i = 10; i >= 0; i--) {
                                char soname[256] = {0};
@@ -471,18 +624,17 @@ static void *swrap_load_lib_handle(enum swrap_lib lib)
                                }
                        }
 
-                       swrap.libsocket_handle = handle;
+                       swrap.libc.socket_handle = handle;
                }
                break;
 #endif
-               /* FALL TROUGH */
        case SWRAP_LIBC:
-               handle = swrap.libc_handle;
+               handle = swrap.libc.handle;
 #ifdef LIBC_SO
                if (handle == NULL) {
                        handle = dlopen(LIBC_SO, flags);
 
-                       swrap.libc_handle = handle;
+                       swrap.libc.handle = handle;
                }
 #endif
                if (handle == NULL) {
@@ -496,14 +648,14 @@ static void *swrap_load_lib_handle(enum swrap_lib lib)
                                }
                        }
 
-                       swrap.libc_handle = handle;
+                       swrap.libc.handle = handle;
                }
                break;
        }
 
        if (handle == NULL) {
 #ifdef RTLD_NEXT
-               handle = swrap.libc_handle = swrap.libsocket_handle = RTLD_NEXT;
+               handle = swrap.libc.handle = swrap.libc.socket_handle = RTLD_NEXT;
 #else
                SWRAP_LOG(SWRAP_LOG_ERROR,
                          "Failed to dlopen library: %s\n",
@@ -515,7 +667,7 @@ static void *swrap_load_lib_handle(enum swrap_lib lib)
        return handle;
 }
 
-static void *_swrap_load_lib_function(enum swrap_lib lib, const char *fn_name)
+static void *_swrap_bind_symbol(enum swrap_lib lib, const char *fn_name)
 {
        void *handle;
        void *func;
@@ -525,107 +677,169 @@ static void *_swrap_load_lib_function(enum swrap_lib lib, const char *fn_name)
        func = dlsym(handle, fn_name);
        if (func == NULL) {
                SWRAP_LOG(SWRAP_LOG_ERROR,
-                               "Failed to find %s: %s\n",
-                               fn_name, dlerror());
+                         "Failed to find %s: %s\n",
+                         fn_name,
+                         dlerror());
                exit(-1);
        }
 
        SWRAP_LOG(SWRAP_LOG_TRACE,
-                       "Loaded %s from %s",
-                       fn_name, swrap_str_lib(lib));
+                 "Loaded %s from %s",
+                 fn_name,
+                 swrap_str_lib(lib));
+
        return func;
 }
 
-#define swrap_load_lib_function(lib, fn_name) \
-       if (swrap.fns.libc_##fn_name == NULL) { \
-               void *swrap_cast_ptr = _swrap_load_lib_function(lib, #fn_name); \
-               *(void **) (&swrap.fns.libc_##fn_name) = \
-                       swrap_cast_ptr; \
+static void swrap_mutex_lock(pthread_mutex_t *mutex)
+{
+       int ret;
+
+       ret = pthread_mutex_lock(mutex);
+       if (ret != 0) {
+               SWRAP_LOG(SWRAP_LOG_ERROR, "Couldn't lock pthread mutex - %s",
+                         strerror(ret));
        }
+}
 
+static void swrap_mutex_unlock(pthread_mutex_t *mutex)
+{
+       int ret;
+
+       ret = pthread_mutex_unlock(mutex);
+       if (ret != 0) {
+               SWRAP_LOG(SWRAP_LOG_ERROR, "Couldn't unlock pthread mutex - %s",
+                         strerror(ret));
+       }
+}
 
 /*
- * IMPORTANT
+ * These macros have a thread race condition on purpose!
  *
- * Functions especially from libc need to be loaded individually, you can't load
- * all at once or gdb will segfault at startup. The same applies to valgrind and
- * has probably something todo with with the linker.
- * So we need load each function at the point it is called the first time.
+ * This is an optimization to avoid locking each time we check if the symbol is
+ * bound.
  */
+#define swrap_bind_symbol_libc(sym_name) \
+       if (swrap.libc.symbols._libc_##sym_name.obj == NULL) { \
+               swrap_mutex_lock(&libc_symbol_binding_mutex); \
+               if (swrap.libc.symbols._libc_##sym_name.obj == NULL) { \
+                       swrap.libc.symbols._libc_##sym_name.obj = \
+                               _swrap_bind_symbol(SWRAP_LIBC, #sym_name); \
+               } \
+               swrap_mutex_unlock(&libc_symbol_binding_mutex); \
+       }
+
+#define swrap_bind_symbol_libsocket(sym_name) \
+       if (swrap.libc.symbols._libc_##sym_name.obj == NULL) { \
+               swrap_mutex_lock(&libc_symbol_binding_mutex); \
+               if (swrap.libc.symbols._libc_##sym_name.obj == NULL) { \
+                       swrap.libc.symbols._libc_##sym_name.obj = \
+                               _swrap_bind_symbol(SWRAP_LIBSOCKET, #sym_name); \
+               } \
+               swrap_mutex_unlock(&libc_symbol_binding_mutex); \
+       }
+
+#define swrap_bind_symbol_libnsl(sym_name) \
+       if (swrap.libc.symbols._libc_##sym_name.obj == NULL) { \
+               swrap_mutex_lock(&libc_symbol_binding_mutex); \
+               if (swrap.libc.symbols._libc_##sym_name.obj == NULL) { \
+                       swrap.libc.symbols._libc_##sym_name.obj = \
+                               _swrap_bind_symbol(SWRAP_LIBNSL, #sym_name); \
+               } \
+               swrap_mutex_unlock(&libc_symbol_binding_mutex); \
+       }
+
+/****************************************************************************
+ *                               IMPORTANT
+ ****************************************************************************
+ *
+ * Functions especially from libc need to be loaded individually, you can't
+ * load all at once or gdb will segfault at startup. The same applies to
+ * valgrind and has probably something todo with with the linker.  So we need
+ * load each function at the point it is called the first time.
+ *
+ ****************************************************************************/
+
+#ifdef HAVE_ACCEPT4
+static int libc_accept4(int sockfd,
+                       struct sockaddr *addr,
+                       socklen_t *addrlen,
+                       int flags)
+{
+       swrap_bind_symbol_libsocket(accept4);
+
+       return swrap.libc.symbols._libc_accept4.f(sockfd, addr, addrlen, flags);
+}
+
+#else /* HAVE_ACCEPT4 */
+
 static int libc_accept(int sockfd, struct sockaddr *addr, socklen_t *addrlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, accept);
+       swrap_bind_symbol_libsocket(accept);
 
-       return swrap.fns.libc_accept(sockfd, addr, addrlen);
+       return swrap.libc.symbols._libc_accept.f(sockfd, addr, addrlen);
 }
+#endif /* HAVE_ACCEPT4 */
 
 static int libc_bind(int sockfd,
                     const struct sockaddr *addr,
                     socklen_t addrlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, bind);
+       swrap_bind_symbol_libsocket(bind);
 
-       return swrap.fns.libc_bind(sockfd, addr, addrlen);
+       return swrap.libc.symbols._libc_bind.f(sockfd, addr, addrlen);
 }
 
 static int libc_close(int fd)
 {
-       swrap_load_lib_function(SWRAP_LIBC, close);
+       swrap_bind_symbol_libc(close);
 
-       return swrap.fns.libc_close(fd);
+       return swrap.libc.symbols._libc_close.f(fd);
 }
 
 static int libc_connect(int sockfd,
                        const struct sockaddr *addr,
                        socklen_t addrlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, connect);
+       swrap_bind_symbol_libsocket(connect);
 
-       return swrap.fns.libc_connect(sockfd, addr, addrlen);
+       return swrap.libc.symbols._libc_connect.f(sockfd, addr, addrlen);
 }
 
 static int libc_dup(int fd)
 {
-       swrap_load_lib_function(SWRAP_LIBC, dup);
+       swrap_bind_symbol_libc(dup);
 
-       return swrap.fns.libc_dup(fd);
+       return swrap.libc.symbols._libc_dup.f(fd);
 }
 
 static int libc_dup2(int oldfd, int newfd)
 {
-       swrap_load_lib_function(SWRAP_LIBC, dup2);
+       swrap_bind_symbol_libc(dup2);
 
-       return swrap.fns.libc_dup2(oldfd, newfd);
+       return swrap.libc.symbols._libc_dup2.f(oldfd, newfd);
 }
 
 #ifdef HAVE_EVENTFD
 static int libc_eventfd(int count, int flags)
 {
-       swrap_load_lib_function(SWRAP_LIBC, eventfd);
+       swrap_bind_symbol_libc(eventfd);
 
-       return swrap.fns.libc_eventfd(count, flags);
+       return swrap.libc.symbols._libc_eventfd.f(count, flags);
 }
 #endif
 
 DO_NOT_SANITIZE_ADDRESS_ATTRIBUTE
 static int libc_vfcntl(int fd, int cmd, va_list ap)
 {
-       long int args[4];
+       void *arg;
        int rc;
-       int i;
 
-       swrap_load_lib_function(SWRAP_LIBC, fcntl);
+       swrap_bind_symbol_libc(fcntl);
 
-       for (i = 0; i < 4; i++) {
-               args[i] = va_arg(ap, long int);
-       }
+       arg = va_arg(ap, void *);
 
-       rc = swrap.fns.libc_fcntl(fd,
-                                 cmd,
-                                 args[0],
-                                 args[1],
-                                 args[2],
-                                 args[3]);
+       rc = swrap.libc.symbols._libc_fcntl.f(fd, cmd, arg);
 
        return rc;
 }
@@ -634,18 +848,18 @@ static int libc_getpeername(int sockfd,
                            struct sockaddr *addr,
                            socklen_t *addrlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, getpeername);
+       swrap_bind_symbol_libsocket(getpeername);
 
-       return swrap.fns.libc_getpeername(sockfd, addr, addrlen);
+       return swrap.libc.symbols._libc_getpeername.f(sockfd, addr, addrlen);
 }
 
 static int libc_getsockname(int sockfd,
                            struct sockaddr *addr,
                            socklen_t *addrlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, getsockname);
+       swrap_bind_symbol_libsocket(getsockname);
 
-       return swrap.fns.libc_getsockname(sockfd, addr, addrlen);
+       return swrap.libc.symbols._libc_getsockname.f(sockfd, addr, addrlen);
 }
 
 static int libc_getsockopt(int sockfd,
@@ -654,58 +868,64 @@ static int libc_getsockopt(int sockfd,
                           void *optval,
                           socklen_t *optlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, getsockopt);
+       swrap_bind_symbol_libsocket(getsockopt);
 
-       return swrap.fns.libc_getsockopt(sockfd, level, optname, optval, optlen);
+       return swrap.libc.symbols._libc_getsockopt.f(sockfd,
+                                                    level,
+                                                    optname,
+                                                    optval,
+                                                    optlen);
 }
 
 DO_NOT_SANITIZE_ADDRESS_ATTRIBUTE
 static int libc_vioctl(int d, unsigned long int request, va_list ap)
 {
-       long int args[4];
+       void *arg;
        int rc;
-       int i;
 
-       swrap_load_lib_function(SWRAP_LIBC, ioctl);
+       swrap_bind_symbol_libc(ioctl);
 
-       for (i = 0; i < 4; i++) {
-               args[i] = va_arg(ap, long int);
-       }
+       arg = va_arg(ap, void *);
 
-       rc = swrap.fns.libc_ioctl(d,
-                                 request,
-                                 args[0],
-                                 args[1],
-                                 args[2],
-                                 args[3]);
+       rc = swrap.libc.symbols._libc_ioctl.f(d, request, arg);
 
        return rc;
 }
 
 static int libc_listen(int sockfd, int backlog)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, listen);
+       swrap_bind_symbol_libsocket(listen);
 
-       return swrap.fns.libc_listen(sockfd, backlog);
+       return swrap.libc.symbols._libc_listen.f(sockfd, backlog);
 }
 
 static FILE *libc_fopen(const char *name, const char *mode)
 {
-       swrap_load_lib_function(SWRAP_LIBC, fopen);
+       swrap_bind_symbol_libc(fopen);
 
-       return swrap.fns.libc_fopen(name, mode);
+       return swrap.libc.symbols._libc_fopen.f(name, mode);
 }
 
+#ifdef HAVE_FOPEN64
+static FILE *libc_fopen64(const char *name, const char *mode)
+{
+       swrap_bind_symbol_libc(fopen64);
+
+       return swrap.libc.symbols._libc_fopen64.f(name, mode);
+}
+#endif /* HAVE_FOPEN64 */
+
 static int libc_vopen(const char *pathname, int flags, va_list ap)
 {
-       long int mode = 0;
+       int mode = 0;
        int fd;
 
-       swrap_load_lib_function(SWRAP_LIBC, open);
-
-       mode = va_arg(ap, long int);
+       swrap_bind_symbol_libc(open);
 
-       fd = swrap.fns.libc_open(pathname, flags, (mode_t)mode);
+       if (flags & O_CREAT) {
+               mode = va_arg(ap, int);
+       }
+       fd = swrap.libc.symbols._libc_open.f(pathname, flags, (mode_t)mode);
 
        return fd;
 }
@@ -722,32 +942,81 @@ static int libc_open(const char *pathname, int flags, ...)
        return fd;
 }
 
+#ifdef HAVE_OPEN64
+static int libc_vopen64(const char *pathname, int flags, va_list ap)
+{
+       int mode = 0;
+       int fd;
+
+       swrap_bind_symbol_libc(open64);
+
+       if (flags & O_CREAT) {
+               mode = va_arg(ap, int);
+       }
+       fd = swrap.libc.symbols._libc_open64.f(pathname, flags, (mode_t)mode);
+
+       return fd;
+}
+#endif /* HAVE_OPEN64 */
+
+static int libc_vopenat(int dirfd, const char *path, int flags, va_list ap)
+{
+       int mode = 0;
+       int fd;
+
+       swrap_bind_symbol_libc(openat);
+
+       if (flags & O_CREAT) {
+               mode = va_arg(ap, int);
+       }
+       fd = swrap.libc.symbols._libc_openat.f(dirfd,
+                                              path,
+                                              flags,
+                                              (mode_t)mode);
+
+       return fd;
+}
+
+#if 0
+static int libc_openat(int dirfd, const char *path, int flags, ...)
+{
+       va_list ap;
+       int fd;
+
+       va_start(ap, flags);
+       fd = libc_vopenat(dirfd, path, flags, ap);
+       va_end(ap);
+
+       return fd;
+}
+#endif
+
 static int libc_pipe(int pipefd[2])
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, pipe);
+       swrap_bind_symbol_libsocket(pipe);
 
-       return swrap.fns.libc_pipe(pipefd);
+       return swrap.libc.symbols._libc_pipe.f(pipefd);
 }
 
 static int libc_read(int fd, void *buf, size_t count)
 {
-       swrap_load_lib_function(SWRAP_LIBC, read);
+       swrap_bind_symbol_libc(read);
 
-       return swrap.fns.libc_read(fd, buf, count);
+       return swrap.libc.symbols._libc_read.f(fd, buf, count);
 }
 
 static ssize_t libc_readv(int fd, const struct iovec *iov, int iovcnt)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, readv);
+       swrap_bind_symbol_libsocket(readv);
 
-       return swrap.fns.libc_readv(fd, iov, iovcnt);
+       return swrap.libc.symbols._libc_readv.f(fd, iov, iovcnt);
 }
 
 static int libc_recv(int sockfd, void *buf, size_t len, int flags)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, recv);
+       swrap_bind_symbol_libsocket(recv);
 
-       return swrap.fns.libc_recv(sockfd, buf, len, flags);
+       return swrap.libc.symbols._libc_recv.f(sockfd, buf, len, flags);
 }
 
 static int libc_recvfrom(int sockfd,
@@ -757,30 +1026,35 @@ static int libc_recvfrom(int sockfd,
                         struct sockaddr *src_addr,
                         socklen_t *addrlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, recvfrom);
+       swrap_bind_symbol_libsocket(recvfrom);
 
-       return swrap.fns.libc_recvfrom(sockfd, buf, len, flags, src_addr, addrlen);
+       return swrap.libc.symbols._libc_recvfrom.f(sockfd,
+                                                  buf,
+                                                  len,
+                                                  flags,
+                                                  src_addr,
+                                                  addrlen);
 }
 
 static int libc_recvmsg(int sockfd, struct msghdr *msg, int flags)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, recvmsg);
+       swrap_bind_symbol_libsocket(recvmsg);
 
-       return swrap.fns.libc_recvmsg(sockfd, msg, flags);
+       return swrap.libc.symbols._libc_recvmsg.f(sockfd, msg, flags);
 }
 
 static int libc_send(int sockfd, const void *buf, size_t len, int flags)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, send);
+       swrap_bind_symbol_libsocket(send);
 
-       return swrap.fns.libc_send(sockfd, buf, len, flags);
+       return swrap.libc.symbols._libc_send.f(sockfd, buf, len, flags);
 }
 
 static int libc_sendmsg(int sockfd, const struct msghdr *msg, int flags)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, sendmsg);
+       swrap_bind_symbol_libsocket(sendmsg);
 
-       return swrap.fns.libc_sendmsg(sockfd, msg, flags);
+       return swrap.libc.symbols._libc_sendmsg.f(sockfd, msg, flags);
 }
 
 static int libc_sendto(int sockfd,
@@ -790,9 +1064,14 @@ static int libc_sendto(int sockfd,
                       const  struct sockaddr *dst_addr,
                       socklen_t addrlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, sendto);
+       swrap_bind_symbol_libsocket(sendto);
 
-       return swrap.fns.libc_sendto(sockfd, buf, len, flags, dst_addr, addrlen);
+       return swrap.libc.symbols._libc_sendto.f(sockfd,
+                                                buf,
+                                                len,
+                                                flags,
+                                                dst_addr,
+                                                addrlen);
 }
 
 static int libc_setsockopt(int sockfd,
@@ -801,55 +1080,112 @@ static int libc_setsockopt(int sockfd,
                           const void *optval,
                           socklen_t optlen)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, setsockopt);
+       swrap_bind_symbol_libsocket(setsockopt);
 
-       return swrap.fns.libc_setsockopt(sockfd, level, optname, optval, optlen);
+       return swrap.libc.symbols._libc_setsockopt.f(sockfd,
+                                                    level,
+                                                    optname,
+                                                    optval,
+                                                    optlen);
 }
 
 #ifdef HAVE_SIGNALFD
 static int libc_signalfd(int fd, const sigset_t *mask, int flags)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, signalfd);
+       swrap_bind_symbol_libsocket(signalfd);
 
-       return swrap.fns.libc_signalfd(fd, mask, flags);
+       return swrap.libc.symbols._libc_signalfd.f(fd, mask, flags);
 }
 #endif
 
 static int libc_socket(int domain, int type, int protocol)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, socket);
+       swrap_bind_symbol_libsocket(socket);
 
-       return swrap.fns.libc_socket(domain, type, protocol);
+       return swrap.libc.symbols._libc_socket.f(domain, type, protocol);
 }
 
 static int libc_socketpair(int domain, int type, int protocol, int sv[2])
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, socketpair);
+       swrap_bind_symbol_libsocket(socketpair);
 
-       return swrap.fns.libc_socketpair(domain, type, protocol, sv);
+       return swrap.libc.symbols._libc_socketpair.f(domain, type, protocol, sv);
 }
 
 #ifdef HAVE_TIMERFD_CREATE
 static int libc_timerfd_create(int clockid, int flags)
 {
-       swrap_load_lib_function(SWRAP_LIBC, timerfd_create);
+       swrap_bind_symbol_libc(timerfd_create);
 
-       return swrap.fns.libc_timerfd_create(clockid, flags);
+       return swrap.libc.symbols._libc_timerfd_create.f(clockid, flags);
 }
 #endif
 
 static ssize_t libc_write(int fd, const void *buf, size_t count)
 {
-       swrap_load_lib_function(SWRAP_LIBC, write);
+       swrap_bind_symbol_libc(write);
 
-       return swrap.fns.libc_write(fd, buf, count);
+       return swrap.libc.symbols._libc_write.f(fd, buf, count);
 }
 
 static ssize_t libc_writev(int fd, const struct iovec *iov, int iovcnt)
 {
-       swrap_load_lib_function(SWRAP_LIBSOCKET, writev);
+       swrap_bind_symbol_libsocket(writev);
+
+       return swrap.libc.symbols._libc_writev.f(fd, iov, iovcnt);
+}
 
-       return swrap.fns.libc_writev(fd, iov, iovcnt);
+/* DO NOT call this function during library initialization! */
+static void swrap_bind_symbol_all(void)
+{
+#ifdef HAVE_ACCEPT4
+       swrap_bind_symbol_libsocket(accept4);
+#else
+       swrap_bind_symbol_libsocket(accept);
+#endif
+       swrap_bind_symbol_libsocket(bind);
+       swrap_bind_symbol_libc(close);
+       swrap_bind_symbol_libsocket(connect);
+       swrap_bind_symbol_libc(dup);
+       swrap_bind_symbol_libc(dup2);
+       swrap_bind_symbol_libc(fcntl);
+       swrap_bind_symbol_libc(fopen);
+#ifdef HAVE_FOPEN64
+       swrap_bind_symbol_libc(fopen64);
+#endif
+#ifdef HAVE_EVENTFD
+       swrap_bind_symbol_libc(eventfd);
+#endif
+       swrap_bind_symbol_libsocket(getpeername);
+       swrap_bind_symbol_libsocket(getsockname);
+       swrap_bind_symbol_libsocket(getsockopt);
+       swrap_bind_symbol_libc(ioctl);
+       swrap_bind_symbol_libsocket(listen);
+       swrap_bind_symbol_libc(open);
+#ifdef HAVE_OPEN64
+       swrap_bind_symbol_libc(open64);
+#endif
+       swrap_bind_symbol_libc(openat);
+       swrap_bind_symbol_libsocket(pipe);
+       swrap_bind_symbol_libc(read);
+       swrap_bind_symbol_libsocket(readv);
+       swrap_bind_symbol_libsocket(recv);
+       swrap_bind_symbol_libsocket(recvfrom);
+       swrap_bind_symbol_libsocket(recvmsg);
+       swrap_bind_symbol_libsocket(send);
+       swrap_bind_symbol_libsocket(sendmsg);
+       swrap_bind_symbol_libsocket(sendto);
+       swrap_bind_symbol_libsocket(setsockopt);
+#ifdef HAVE_SIGNALFD
+       swrap_bind_symbol_libsocket(signalfd);
+#endif
+       swrap_bind_symbol_libsocket(socket);
+       swrap_bind_symbol_libsocket(socketpair);
+#ifdef HAVE_TIMERFD_CREATE
+       swrap_bind_symbol_libc(timerfd_create);
+#endif
+       swrap_bind_symbol_libc(write);
+       swrap_bind_symbol_libsocket(writev);
 }
 
 /*********************************************************
@@ -907,19 +1243,64 @@ static size_t socket_length(int family)
        return 0;
 }
 
-static const char *socket_wrapper_dir(void)
+static struct socket_info *swrap_get_socket_info(int si_index)
+{
+       return (struct socket_info *)(&(sockets[si_index].info));
+}
+
+static int swrap_get_refcount(struct socket_info *si)
+{
+       struct socket_info_container *sic = SOCKET_INFO_CONTAINER(si);
+       return sic->meta.refcount;
+}
+
+static void swrap_inc_refcount(struct socket_info *si)
 {
-       const char *s = getenv("SOCKET_WRAPPER_DIR");
+       struct socket_info_container *sic = SOCKET_INFO_CONTAINER(si);
+
+       sic->meta.refcount += 1;
+}
+
+static void swrap_dec_refcount(struct socket_info *si)
+{
+       struct socket_info_container *sic = SOCKET_INFO_CONTAINER(si);
+
+       sic->meta.refcount -= 1;
+}
+
+static int swrap_get_next_free(struct socket_info *si)
+{
+       struct socket_info_container *sic = SOCKET_INFO_CONTAINER(si);
+
+       return sic->meta.next_free;
+}
+
+static void swrap_set_next_free(struct socket_info *si, int next_free)
+{
+       struct socket_info_container *sic = SOCKET_INFO_CONTAINER(si);
+
+       sic->meta.next_free = next_free;
+}
+
+static char *socket_wrapper_dir(void)
+{
+       char *swrap_dir = NULL;
+       char *s = getenv("SOCKET_WRAPPER_DIR");
+
        if (s == NULL) {
                return NULL;
        }
-       /* TODO use realpath(3) here, when we add support for threads */
-       if (strncmp(s, "./", 2) == 0) {
-               s += 2;
+
+       swrap_dir = realpath(s, NULL);
+       if (swrap_dir == NULL) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Unable to resolve socket_wrapper dir path: %s",
+                         strerror(errno));
+               return NULL;
        }
 
-       SWRAP_LOG(SWRAP_LOG_TRACE, "socket_wrapper_dir: %s", s);
-       return s;
+       SWRAP_LOG(SWRAP_LOG_TRACE, "socket_wrapper_dir: %s", swrap_dir);
+       return swrap_dir;
 }
 
 static unsigned int socket_wrapper_mtu(void)
@@ -929,8 +1310,10 @@ static unsigned int socket_wrapper_mtu(void)
        const char *s;
        char *endp;
 
+       swrap_mutex_lock(&mtu_update_mutex);
+
        if (max_mtu != 0) {
-               return max_mtu;
+               goto done;
        }
 
        max_mtu = SOCKET_WRAPPER_MTU_DEFAULT;
@@ -951,14 +1334,188 @@ static unsigned int socket_wrapper_mtu(void)
        max_mtu = tmp;
 
 done:
+       swrap_mutex_unlock(&mtu_update_mutex);
        return max_mtu;
 }
 
+static int socket_wrapper_init_mutex(pthread_mutex_t *m)
+{
+       pthread_mutexattr_t ma;
+       int ret;
+
+       ret = pthread_mutexattr_init(&ma);
+       if (ret != 0) {
+               return ret;
+       }
+
+       ret = pthread_mutexattr_settype(&ma, PTHREAD_MUTEX_ERRORCHECK);
+       if (ret != 0) {
+               goto done;
+       }
+
+       ret = pthread_mutex_init(m, &ma);
+
+done:
+       pthread_mutexattr_destroy(&ma);
+
+       return ret;
+}
+
+static size_t socket_wrapper_max_sockets(void)
+{
+       const char *s;
+       size_t tmp;
+       char *endp;
+
+       if (socket_info_max != 0) {
+               return socket_info_max;
+       }
+
+       socket_info_max = SOCKET_WRAPPER_MAX_SOCKETS_DEFAULT;
+
+       s = getenv("SOCKET_WRAPPER_MAX_SOCKETS");
+       if (s == NULL || s[0] == '\0') {
+               goto done;
+       }
+
+       tmp = strtoul(s, &endp, 10);
+       if (s == endp) {
+               goto done;
+       }
+       if (tmp == 0) {
+               tmp = SOCKET_WRAPPER_MAX_SOCKETS_DEFAULT;
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Invalid number of sockets specified, "
+                         "using default (%zu)",
+                         tmp);
+       }
+
+       if (tmp > SOCKET_WRAPPER_MAX_SOCKETS_LIMIT) {
+               tmp = SOCKET_WRAPPER_MAX_SOCKETS_LIMIT;
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Invalid number of sockets specified, "
+                         "using maximum (%zu).",
+                         tmp);
+       }
+
+       socket_info_max = tmp;
+
+done:
+       return socket_info_max;
+}
+
+static void socket_wrapper_init_fds_idx(void)
+{
+       int *tmp = NULL;
+       size_t i;
+
+       if (socket_fds_idx != NULL) {
+               return;
+       }
+
+       tmp = (int *)calloc(socket_fds_max, sizeof(int));
+       if (tmp == NULL) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Failed to allocate socket fds index array: %s",
+                         strerror(errno));
+               exit(-1);
+       }
+
+       for (i = 0; i < socket_fds_max; i++) {
+               tmp[i] = -1;
+       }
+
+       socket_fds_idx = tmp;
+}
+
+static void socket_wrapper_init_sockets(void)
+{
+       size_t max_sockets;
+       size_t i;
+       int ret;
+
+       swrap_mutex_lock(&sockets_mutex);
+
+       if (sockets != NULL) {
+               swrap_mutex_unlock(&sockets_mutex);
+               return;
+       }
+
+       socket_wrapper_init_fds_idx();
+
+       /* Needs to be called inside the sockets_mutex lock here. */
+       max_sockets = socket_wrapper_max_sockets();
+
+       sockets = (struct socket_info_container *)calloc(max_sockets,
+                                       sizeof(struct socket_info_container));
+
+       if (sockets == NULL) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Failed to allocate sockets array: %s",
+                         strerror(errno));
+               swrap_mutex_unlock(&sockets_mutex);
+               exit(-1);
+       }
+
+       swrap_mutex_lock(&first_free_mutex);
+
+       first_free = 0;
+
+       for (i = 0; i < max_sockets; i++) {
+               swrap_set_next_free(&sockets[i].info, i+1);
+               ret = socket_wrapper_init_mutex(&sockets[i].meta.mutex);
+               if (ret != 0) {
+                       SWRAP_LOG(SWRAP_LOG_ERROR,
+                                 "Failed to initialize pthread mutex");
+                       goto done;
+               }
+       }
+
+       /* mark the end of the free list */
+       swrap_set_next_free(&sockets[max_sockets-1].info, -1);
+
+       ret = socket_wrapper_init_mutex(&autobind_start_mutex);
+       if (ret != 0) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Failed to initialize pthread mutex");
+               goto done;
+       }
+
+       ret = socket_wrapper_init_mutex(&pcap_dump_mutex);
+       if (ret != 0) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Failed to initialize pthread mutex");
+               goto done;
+       }
+
+       ret = socket_wrapper_init_mutex(&mtu_update_mutex);
+       if (ret != 0) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Failed to initialize pthread mutex");
+               goto done;
+       }
+
+done:
+       swrap_mutex_unlock(&first_free_mutex);
+       swrap_mutex_unlock(&sockets_mutex);
+       if (ret != 0) {
+               exit(-1);
+       }
+}
+
 bool socket_wrapper_enabled(void)
 {
-       const char *s = socket_wrapper_dir();
+       char *s = socket_wrapper_dir();
+
+       if (s == NULL) {
+               return false;
+       }
+
+       SAFE_FREE(s);
 
-       return s != NULL ? true : false;
+       socket_wrapper_init_sockets();
+
+       return true;
 }
 
 static unsigned int socket_wrapper_default_iface(void)
@@ -976,6 +1533,110 @@ static unsigned int socket_wrapper_default_iface(void)
        return 1;/* 127.0.0.1 */
 }
 
+static void set_socket_info_index(int fd, int idx)
+{
+       socket_fds_idx[fd] = idx;
+       /* This builtin issues a full memory barrier. */
+       __sync_synchronize();
+}
+
+static void reset_socket_info_index(int fd)
+{
+       set_socket_info_index(fd, -1);
+}
+
+static int find_socket_info_index(int fd)
+{
+       if (fd < 0) {
+               return -1;
+       }
+
+       if (socket_fds_idx == NULL) {
+               return -1;
+       }
+
+       if ((size_t)fd >= socket_fds_max) {
+               /*
+                * Do not add a log here as some applications do stupid things
+                * like:
+                *
+                *     for (fd = 0; fd <= getdtablesize(); fd++) {
+                *         close(fd)
+                *     };
+                *
+                * This would produce millions of lines of debug messages.
+                */
+#if 0
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Looking for a socket info for the fd %d is over the "
+                         "max socket index limit of %zu.",
+                         fd,
+                         socket_fds_max);
+#endif
+               return -1;
+       }
+
+       /* This builtin issues a full memory barrier. */
+       __sync_synchronize();
+       return socket_fds_idx[fd];
+}
+
+static int swrap_add_socket_info(struct socket_info *si_input)
+{
+       struct socket_info *si = NULL;
+       int si_index = -1;
+
+       if (si_input == NULL) {
+               errno = EINVAL;
+               return -1;
+       }
+
+       swrap_mutex_lock(&first_free_mutex);
+       if (first_free == -1) {
+               errno = ENFILE;
+               goto out;
+       }
+
+       si_index = first_free;
+       si = swrap_get_socket_info(si_index);
+
+       SWRAP_LOCK_SI(si);
+
+       first_free = swrap_get_next_free(si);
+       *si = *si_input;
+       swrap_inc_refcount(si);
+
+       SWRAP_UNLOCK_SI(si);
+
+out:
+       swrap_mutex_unlock(&first_free_mutex);
+
+       return si_index;
+}
+
+static int swrap_create_socket(struct socket_info *si, int fd)
+{
+       int idx;
+
+       if ((size_t)fd >= socket_fds_max) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "The max socket index limit of %zu has been reached, "
+                         "trying to add %d",
+                         socket_fds_max,
+                         fd);
+               return -1;
+       }
+
+       idx = swrap_add_socket_info(si);
+       if (idx == -1) {
+               return -1;
+       }
+
+       set_socket_info_index(fd, idx);
+
+       return idx;
+}
+
 static int convert_un_in(const struct sockaddr_un *un, struct sockaddr *in, socklen_t *len)
 {
        unsigned int iface;
@@ -1057,6 +1718,7 @@ static int convert_in_un_remote(struct socket_info *si, const struct sockaddr *i
        unsigned int prt;
        unsigned int iface;
        int is_bcast = 0;
+       char *swrap_dir = NULL;
 
        if (bcast) *bcast = 0;
 
@@ -1155,18 +1817,23 @@ static int convert_in_un_remote(struct socket_info *si, const struct sockaddr *i
                return -1;
        }
 
+       swrap_dir = socket_wrapper_dir();
+
        if (is_bcast) {
-               snprintf(un->sun_path, sizeof(un->sun_path), "%s/EINVAL",
-                        socket_wrapper_dir());
+               snprintf(un->sun_path, sizeof(un->sun_path),
+                        "%s/EINVAL", swrap_dir);
                SWRAP_LOG(SWRAP_LOG_DEBUG, "un path [%s]", un->sun_path);
+               SAFE_FREE(swrap_dir);
                /* the caller need to do more processing */
                return 0;
        }
 
        snprintf(un->sun_path, sizeof(un->sun_path), "%s/"SOCKET_FORMAT,
-                socket_wrapper_dir(), type, iface, prt);
+                swrap_dir, type, iface, prt);
        SWRAP_LOG(SWRAP_LOG_DEBUG, "un path [%s]", un->sun_path);
 
+       SAFE_FREE(swrap_dir);
+
        return 0;
 }
 
@@ -1178,6 +1845,7 @@ static int convert_in_un_alloc(struct socket_info *si, const struct sockaddr *in
        unsigned int iface;
        struct stat st;
        int is_bcast = 0;
+       char *swrap_dir = NULL;
 
        if (bcast) *bcast = 0;
 
@@ -1212,7 +1880,7 @@ static int convert_in_un_alloc(struct socket_info *si, const struct sockaddr *in
 
                if (addr == 0) {
                        /* 0.0.0.0 */
-                       is_bcast = 0;
+                       is_bcast = 0;
                        type = d_type;
                        iface = socket_wrapper_default_iface();
                } else if (a_type && addr == 0xFFFFFFFF) {
@@ -1319,11 +1987,13 @@ static int convert_in_un_alloc(struct socket_info *si, const struct sockaddr *in
                return -1;
        }
 
+       swrap_dir = socket_wrapper_dir();
+
        if (prt == 0) {
                /* handle auto-allocation of ephemeral ports */
                for (prt = 5001; prt < 10000; prt++) {
                        snprintf(un->sun_path, sizeof(un->sun_path), "%s/"SOCKET_FORMAT,
-                                socket_wrapper_dir(), type, iface, prt);
+                                swrap_dir, type, iface, prt);
                        if (stat(un->sun_path, &st) == 0) continue;
 
                        set_port(si->family, prt, &si->myname);
@@ -1331,38 +2001,39 @@ static int convert_in_un_alloc(struct socket_info *si, const struct sockaddr *in
 
                        break;
                }
+
                if (prt == 10000) {
                        errno = ENFILE;
+                       SAFE_FREE(swrap_dir);
                        return -1;
                }
        }
 
        snprintf(un->sun_path, sizeof(un->sun_path), "%s/"SOCKET_FORMAT,
-                socket_wrapper_dir(), type, iface, prt);
+                swrap_dir, type, iface, prt);
        SWRAP_LOG(SWRAP_LOG_DEBUG, "un path [%s]", un->sun_path);
+
+       SAFE_FREE(swrap_dir);
+
        return 0;
 }
 
 static struct socket_info *find_socket_info(int fd)
 {
-       struct socket_info *i;
+       int idx = find_socket_info_index(fd);
 
-       for (i = sockets; i; i = i->next) {
-               struct socket_info_fd *f;
-               for (f = i->fds; f; f = f->next) {
-                       if (f->fd == fd) {
-                               return i;
-                       }
-               }
+       if (idx == -1) {
+               return NULL;
        }
 
-       return NULL;
+       return swrap_get_socket_info(idx);
 }
 
 #if 0 /* FIXME */
 static bool check_addr_port_in_use(const struct sockaddr *sa, socklen_t len)
 {
-       struct socket_info *s;
+       struct socket_info_fd *f;
+       const struct socket_info *last_s = NULL;
 
        /* first catch invalid input */
        switch (sa->sa_family) {
@@ -1371,7 +2042,7 @@ static bool check_addr_port_in_use(const struct sockaddr *sa, socklen_t len)
                        return false;
                }
                break;
-#if HAVE_IPV6
+#ifdef HAVE_IPV6
        case AF_INET6:
                if (len < sizeof(struct sockaddr_in6)) {
                        return false;
@@ -1383,7 +2054,14 @@ static bool check_addr_port_in_use(const struct sockaddr *sa, socklen_t len)
                break;
        }
 
-       for (s = sockets; s != NULL; s = s->next) {
+       for (f = socket_fds; f; f = f->next) {
+               struct socket_info *s = swrap_get_socket_info(f->si_index);
+
+               if (s == last_s) {
+                       continue;
+               }
+               last_s = s;
+
                if (s->myname == NULL) {
                        continue;
                }
@@ -1411,7 +2089,7 @@ static bool check_addr_port_in_use(const struct sockaddr *sa, socklen_t len)
                        return true;
                        break;
                }
-#if HAVE_IPV6
+#ifdef HAVE_IPV6
                case AF_INET6: {
                        struct sockaddr_in6 *sin1, *sin2;
 
@@ -1445,27 +2123,43 @@ static bool check_addr_port_in_use(const struct sockaddr *sa, socklen_t len)
 
 static void swrap_remove_stale(int fd)
 {
-       struct socket_info *si = find_socket_info(fd);
-       struct socket_info_fd *fi;
+       struct socket_info *si;
+       int si_index;
 
-       if (si != NULL) {
-               for (fi = si->fds; fi; fi = fi->next) {
-                       if (fi->fd == fd) {
-                               SWRAP_LOG(SWRAP_LOG_TRACE, "remove stale wrapper for %d", fd);
-                               SWRAP_DLIST_REMOVE(si->fds, fi);
-                               free(fi);
-                               break;
-                       }
-               }
+       SWRAP_LOG(SWRAP_LOG_TRACE, "remove stale wrapper for %d", fd);
 
-               if (si->fds == NULL) {
-                       SWRAP_DLIST_REMOVE(sockets, si);
-                       if (si->un_addr.sun_path[0] != '\0') {
-                               unlink(si->un_addr.sun_path);
-                       }
-                       free(si);
-               }
+       swrap_mutex_lock(&socket_reset_mutex);
+
+       si_index = find_socket_info_index(fd);
+       if (si_index == -1) {
+               swrap_mutex_unlock(&socket_reset_mutex);
+               return;
        }
+
+       reset_socket_info_index(fd);
+
+       si = swrap_get_socket_info(si_index);
+
+       swrap_mutex_lock(&first_free_mutex);
+       SWRAP_LOCK_SI(si);
+
+       swrap_dec_refcount(si);
+
+       if (swrap_get_refcount(si) > 0) {
+               goto out;
+       }
+
+       if (si->un_addr.sun_path[0] != '\0') {
+               unlink(si->un_addr.sun_path);
+       }
+
+       swrap_set_next_free(si, first_free);
+       first_free = si_index;
+
+out:
+       SWRAP_UNLOCK_SI(si);
+       swrap_mutex_unlock(&first_free_mutex);
+       swrap_mutex_unlock(&socket_reset_mutex);
 }
 
 static int sockaddr_convert_to_un(struct socket_info *si,
@@ -1507,7 +2201,7 @@ static int sockaddr_convert_to_un(struct socket_info *si,
                 * AF_UNSPEC is mapped to AF_INET and must be treated here.
                 */
 
-               /* FALL THROUGH */
+               FALL_THROUGH;
        }
        case AF_INET:
 #ifdef HAVE_IPV6
@@ -1767,14 +2461,20 @@ static uint8_t *swrap_pcap_packet_init(struct timeval *tval,
                                       int unreachable,
                                       size_t *_packet_len)
 {
-       uint8_t *base;
-       uint8_t *buf;
-       struct swrap_packet_frame *frame;
-       union swrap_packet_ip *ip;
+       uint8_t *base = NULL;
+       uint8_t *buf = NULL;
+       union {
+               uint8_t *ptr;
+               struct swrap_packet_frame *frame;
+       } f;
+       union {
+               uint8_t *ptr;
+               union swrap_packet_ip *ip;
+       } i;
        union swrap_packet_payload *pay;
        size_t packet_len;
        size_t alloc_len;
-       size_t nonwire_len = sizeof(*frame);
+       size_t nonwire_len = sizeof(struct swrap_packet_frame);
        size_t wire_hdr_len = 0;
        size_t wire_len = 0;
        size_t ip_hdr_len = 0;
@@ -1796,7 +2496,7 @@ static uint8_t *swrap_pcap_packet_init(struct timeval *tval,
                dest_in = (const struct sockaddr_in *)(const void *)dest;
                src_port = src_in->sin_port;
                dest_port = dest_in->sin_port;
-               ip_hdr_len = sizeof(ip->v4);
+               ip_hdr_len = sizeof(i.ip->v4);
                break;
 #ifdef HAVE_IPV6
        case AF_INET6:
@@ -1804,7 +2504,7 @@ static uint8_t *swrap_pcap_packet_init(struct timeval *tval,
                dest_in6 = (const struct sockaddr_in6 *)(const void *)dest;
                src_port = src_in6->sin6_port;
                dest_port = dest_in6->sin6_port;
-               ip_hdr_len = sizeof(ip->v6);
+               ip_hdr_len = sizeof(i.ip->v6);
                break;
 #endif
        default:
@@ -1845,7 +2545,6 @@ static uint8_t *swrap_pcap_packet_init(struct timeval *tval,
                if (wire_len > 64 ) {
                        icmp_truncate_len = wire_len - 64;
                }
-               wire_hdr_len += icmp_hdr_len;
                wire_len += icmp_hdr_len;
        }
 
@@ -1861,39 +2560,40 @@ static uint8_t *swrap_pcap_packet_init(struct timeval *tval,
        }
 
        buf = base;
+       f.ptr = buf;
+
+       f.frame->seconds                = tval->tv_sec;
+       f.frame->micro_seconds  = tval->tv_usec;
+       f.frame->recorded_length        = wire_len - icmp_truncate_len;
+       f.frame->full_length    = wire_len - icmp_truncate_len;
 
-       frame = (struct swrap_packet_frame *)(void *)buf;
-       frame->seconds          = tval->tv_sec;
-       frame->micro_seconds    = tval->tv_usec;
-       frame->recorded_length  = wire_len - icmp_truncate_len;
-       frame->full_length      = wire_len - icmp_truncate_len;
        buf += SWRAP_PACKET_FRAME_SIZE;
 
-       ip = (union swrap_packet_ip *)(void *)buf;
+       i.ptr = buf;
        switch (src->sa_family) {
        case AF_INET:
-               ip->v4.ver_hdrlen       = 0x45; /* version 4 and 5 * 32 bit words */
-               ip->v4.tos              = 0x00;
-               ip->v4.packet_length    = htons(wire_len - icmp_truncate_len);
-               ip->v4.identification   = htons(0xFFFF);
-               ip->v4.flags            = 0x40; /* BIT 1 set - means don't fragment */
-               ip->v4.fragment         = htons(0x0000);
-               ip->v4.ttl              = 0xFF;
-               ip->v4.protocol         = protocol;
-               ip->v4.hdr_checksum     = htons(0x0000);
-               ip->v4.src_addr         = src_in->sin_addr.s_addr;
-               ip->v4.dest_addr        = dest_in->sin_addr.s_addr;
+               i.ip->v4.ver_hdrlen     = 0x45; /* version 4 and 5 * 32 bit words */
+               i.ip->v4.tos            = 0x00;
+               i.ip->v4.packet_length  = htons(wire_len - icmp_truncate_len);
+               i.ip->v4.identification = htons(0xFFFF);
+               i.ip->v4.flags          = 0x40; /* BIT 1 set - means don't fragment */
+               i.ip->v4.fragment       = htons(0x0000);
+               i.ip->v4.ttl            = 0xFF;
+               i.ip->v4.protocol       = protocol;
+               i.ip->v4.hdr_checksum   = htons(0x0000);
+               i.ip->v4.src_addr       = src_in->sin_addr.s_addr;
+               i.ip->v4.dest_addr      = dest_in->sin_addr.s_addr;
                buf += SWRAP_PACKET_IP_V4_SIZE;
                break;
 #ifdef HAVE_IPV6
        case AF_INET6:
-               ip->v6.ver_prio         = 0x60; /* version 4 and 5 * 32 bit words */
-               ip->v6.flow_label_high  = 0x00;
-               ip->v6.flow_label_low   = 0x0000;
-               ip->v6.payload_length   = htons(wire_len - icmp_truncate_len); /* TODO */
-               ip->v6.next_header      = protocol;
-               memcpy(ip->v6.src_addr, src_in6->sin6_addr.s6_addr, 16);
-               memcpy(ip->v6.dest_addr, dest_in6->sin6_addr.s6_addr, 16);
+               i.ip->v6.ver_prio               = 0x60; /* version 4 and 5 * 32 bit words */
+               i.ip->v6.flow_label_high        = 0x00;
+               i.ip->v6.flow_label_low = 0x0000;
+               i.ip->v6.payload_length = htons(wire_len - icmp_truncate_len); /* TODO */
+               i.ip->v6.next_header    = protocol;
+               memcpy(i.ip->v6.src_addr, src_in6->sin6_addr.s6_addr, 16);
+               memcpy(i.ip->v6.dest_addr, dest_in6->sin6_addr.s6_addr, 16);
                buf += SWRAP_PACKET_IP_V6_SIZE;
                break;
 #endif
@@ -1907,21 +2607,23 @@ static uint8_t *swrap_pcap_packet_init(struct timeval *tval,
                        pay->icmp4.code         = 0x01; /* host unreachable */
                        pay->icmp4.checksum     = htons(0x0000);
                        pay->icmp4.unused       = htonl(0x00000000);
+
                        buf += SWRAP_PACKET_PAYLOAD_ICMP4_SIZE;
 
                        /* set the ip header in the ICMP payload */
-                       ip = (union swrap_packet_ip *)(void *)buf;
-                       ip->v4.ver_hdrlen       = 0x45; /* version 4 and 5 * 32 bit words */
-                       ip->v4.tos              = 0x00;
-                       ip->v4.packet_length    = htons(wire_len - icmp_hdr_len);
-                       ip->v4.identification   = htons(0xFFFF);
-                       ip->v4.flags            = 0x40; /* BIT 1 set - means don't fragment */
-                       ip->v4.fragment         = htons(0x0000);
-                       ip->v4.ttl              = 0xFF;
-                       ip->v4.protocol         = icmp_protocol;
-                       ip->v4.hdr_checksum     = htons(0x0000);
-                       ip->v4.src_addr         = dest_in->sin_addr.s_addr;
-                       ip->v4.dest_addr        = src_in->sin_addr.s_addr;
+                       i.ptr = buf;
+                       i.ip->v4.ver_hdrlen     = 0x45; /* version 4 and 5 * 32 bit words */
+                       i.ip->v4.tos            = 0x00;
+                       i.ip->v4.packet_length  = htons(wire_len - icmp_hdr_len);
+                       i.ip->v4.identification = htons(0xFFFF);
+                       i.ip->v4.flags          = 0x40; /* BIT 1 set - means don't fragment */
+                       i.ip->v4.fragment       = htons(0x0000);
+                       i.ip->v4.ttl            = 0xFF;
+                       i.ip->v4.protocol       = icmp_protocol;
+                       i.ip->v4.hdr_checksum   = htons(0x0000);
+                       i.ip->v4.src_addr       = dest_in->sin_addr.s_addr;
+                       i.ip->v4.dest_addr      = src_in->sin_addr.s_addr;
+
                        buf += SWRAP_PACKET_IP_V4_SIZE;
 
                        src_port = dest_in->sin_port;
@@ -1936,14 +2638,15 @@ static uint8_t *swrap_pcap_packet_init(struct timeval *tval,
                        buf += SWRAP_PACKET_PAYLOAD_ICMP6_SIZE;
 
                        /* set the ip header in the ICMP payload */
-                       ip = (union swrap_packet_ip *)(void *)buf;
-                       ip->v6.ver_prio         = 0x60; /* version 4 and 5 * 32 bit words */
-                       ip->v6.flow_label_high  = 0x00;
-                       ip->v6.flow_label_low   = 0x0000;
-                       ip->v6.payload_length   = htons(wire_len - icmp_truncate_len); /* TODO */
-                       ip->v6.next_header      = protocol;
-                       memcpy(ip->v6.src_addr, dest_in6->sin6_addr.s6_addr, 16);
-                       memcpy(ip->v6.dest_addr, src_in6->sin6_addr.s6_addr, 16);
+                       i.ptr = buf;
+                       i.ip->v6.ver_prio               = 0x60; /* version 4 and 5 * 32 bit words */
+                       i.ip->v6.flow_label_high        = 0x00;
+                       i.ip->v6.flow_label_low = 0x0000;
+                       i.ip->v6.payload_length = htons(wire_len - icmp_truncate_len); /* TODO */
+                       i.ip->v6.next_header    = protocol;
+                       memcpy(i.ip->v6.src_addr, dest_in6->sin6_addr.s6_addr, 16);
+                       memcpy(i.ip->v6.dest_addr, src_in6->sin6_addr.s6_addr, 16);
+
                        buf += SWRAP_PACKET_IP_V6_SIZE;
 
                        src_port = dest_in6->sin6_port;
@@ -1992,13 +2695,15 @@ static int swrap_pcap_get_fd(const char *fname)
 {
        static int fd = -1;
 
-       if (fd != -1) return fd;
+       if (fd != -1) {
+               return fd;
+       }
 
        fd = libc_open(fname, O_WRONLY|O_CREAT|O_EXCL|O_APPEND, 0644);
        if (fd != -1) {
                struct swrap_file_hdr file_hdr;
                file_hdr.magic          = 0xA1B2C3D4;
-               file_hdr.version_major  = 0x0002;       
+               file_hdr.version_major  = 0x0002;
                file_hdr.version_minor  = 0x0004;
                file_hdr.timezone       = 0x00000000;
                file_hdr.sigfigs        = 0x00000000;
@@ -2045,7 +2750,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
 
        switch (type) {
        case SWRAP_CONNECT_SEND:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                src_addr  = &si->myname.sa.s;
                dest_addr = addr;
@@ -2059,7 +2766,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_CONNECT_RECV:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                dest_addr = &si->myname.sa.s;
                src_addr = addr;
@@ -2073,7 +2782,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_CONNECT_UNREACH:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                dest_addr = &si->myname.sa.s;
                src_addr  = addr;
@@ -2087,7 +2798,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_CONNECT_ACK:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                src_addr  = &si->myname.sa.s;
                dest_addr = addr;
@@ -2099,7 +2812,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_ACCEPT_SEND:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                dest_addr = &si->myname.sa.s;
                src_addr = addr;
@@ -2113,7 +2828,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_ACCEPT_RECV:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                src_addr = &si->myname.sa.s;
                dest_addr = addr;
@@ -2127,7 +2844,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_ACCEPT_ACK:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                dest_addr = &si->myname.sa.s;
                src_addr = addr;
@@ -2234,7 +2953,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_CLOSE_SEND:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                src_addr  = &si->myname.sa.s;
                dest_addr = &si->peername.sa.s;
@@ -2248,7 +2969,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_CLOSE_RECV:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                dest_addr = &si->myname.sa.s;
                src_addr  = &si->peername.sa.s;
@@ -2262,7 +2985,9 @@ static uint8_t *swrap_pcap_marshall_packet(struct socket_info *si,
                break;
 
        case SWRAP_CLOSE_ACK:
-               if (si->type != SOCK_STREAM) return NULL;
+               if (si->type != SOCK_STREAM) {
+                       return NULL;
+               }
 
                src_addr  = &si->myname.sa.s;
                dest_addr = &si->peername.sa.s;
@@ -2301,9 +3026,11 @@ static void swrap_pcap_dump_packet(struct socket_info *si,
        size_t packet_len = 0;
        int fd;
 
+       swrap_mutex_lock(&pcap_dump_mutex);
+
        file_name = swrap_pcap_init_file();
        if (!file_name) {
-               return;
+               goto done;
        }
 
        packet = swrap_pcap_marshall_packet(si,
@@ -2313,18 +3040,21 @@ static void swrap_pcap_dump_packet(struct socket_info *si,
                                            len,
                                            &packet_len);
        if (packet == NULL) {
-               return;
+               goto done;
        }
 
        fd = swrap_pcap_get_fd(file_name);
        if (fd != -1) {
                if (write(fd, packet, packet_len) != (ssize_t)packet_len) {
                        free(packet);
-                       return;
+                       goto done;
                }
        }
 
        free(packet);
+
+done:
+       swrap_mutex_unlock(&pcap_dump_mutex);
 }
 
 /****************************************************************************
@@ -2356,9 +3086,10 @@ int signalfd(int fd, const sigset_t *mask, int flags)
 
 static int swrap_socket(int family, int type, int protocol)
 {
-       struct socket_info *si;
-       struct socket_info_fd *fi;
+       struct socket_info *si = NULL;
+       struct socket_info _si = { 0 };
        int fd;
+       int ret;
        int real_type = type;
 
        /*
@@ -2386,6 +3117,9 @@ static int swrap_socket(int family, int type, int protocol)
 #ifdef AF_NETLINK
        case AF_NETLINK:
 #endif /* AF_NETLINK */
+#ifdef AF_PACKET
+       case AF_PACKET:
+#endif /* AF_PACKET */
        case AF_UNIX:
                return libc_socket(family, type, protocol);
        default:
@@ -2410,12 +3144,12 @@ static int swrap_socket(int family, int type, int protocol)
                if (real_type == SOCK_STREAM) {
                        break;
                }
-               /*fall through*/
+               FALL_THROUGH;
        case 17:
                if (real_type == SOCK_DGRAM) {
                        break;
                }
-               /*fall through*/
+               FALL_THROUGH;
        default:
                errno = EPROTONOSUPPORT;
                return -1;
@@ -2432,17 +3166,9 @@ static int swrap_socket(int family, int type, int protocol)
        }
 
        /* Check if we have a stale fd and remove it */
-       si = find_socket_info(fd);
-       if (si != NULL) {
-               swrap_remove_stale(fd);
-       }
-
-       si = (struct socket_info *)calloc(1, sizeof(struct socket_info));
-       if (si == NULL) {
-               errno = ENOMEM;
-               return -1;
-       }
+       swrap_remove_stale(fd);
 
+       si = &_si;
        si->family = family;
 
        /* however, the rest of the socket_wrapper code expects just
@@ -2464,6 +3190,7 @@ static int swrap_socket(int family, int type, int protocol)
                memcpy(&si->myname.sa.in, &sin, si->myname.sa_socklen);
                break;
        }
+#ifdef HAVE_IPV6
        case AF_INET6: {
                struct sockaddr_in6 sin6 = {
                        .sin6_family = AF_INET6,
@@ -2473,28 +3200,22 @@ static int swrap_socket(int family, int type, int protocol)
                memcpy(&si->myname.sa.in6, &sin6, si->myname.sa_socklen);
                break;
        }
+#endif
        default:
-               free(si);
                errno = EINVAL;
                return -1;
        }
 
-       fi = (struct socket_info_fd *)calloc(1, sizeof(struct socket_info_fd));
-       if (fi == NULL) {
-               free(si);
-               errno = ENOMEM;
+       ret = swrap_create_socket(si, fd);
+       if (ret == -1) {
                return -1;
        }
 
-       fi->fd = fd;
-
-       SWRAP_DLIST_ADD(si->fds, fi);
-       SWRAP_DLIST_ADD(sockets, si);
-
        SWRAP_LOG(SWRAP_LOG_TRACE,
-                 "Created %s socket for protocol %s",
-                 si->family == AF_INET ? "IPv4" : "IPv6",
-                 si->type == SOCK_DGRAM ? "UDP" : "TCP");
+                 "Created %s socket for protocol %s, fd=%d",
+                 family == AF_INET ? "IPv4" : "IPv6",
+                 real_type == SOCK_DGRAM ? "UDP" : "TCP",
+                 fd);
 
        return fd;
 }
@@ -2575,11 +3296,15 @@ int pipe(int pipefd[2])
  *   ACCEPT
  ***************************************************************************/
 
-static int swrap_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
+static int swrap_accept(int s,
+                       struct sockaddr *addr,
+                       socklen_t *addrlen,
+                       int flags)
 {
        struct socket_info *parent_si, *child_si;
-       struct socket_info_fd *child_fi;
+       struct socket_info new_si = { 0 };
        int fd;
+       int idx;
        struct swrap_address un_addr = {
                .sa_socklen = sizeof(struct sockaddr_un),
        };
@@ -2596,20 +3321,40 @@ static int swrap_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
 
        parent_si = find_socket_info(s);
        if (!parent_si) {
+#ifdef HAVE_ACCEPT4
+               return libc_accept4(s, addr, addrlen, flags);
+#else
+               UNUSED(flags);
                return libc_accept(s, addr, addrlen);
+#endif
        }
 
+
+       /*
+        * prevent parent_si from being altered / closed
+        * while we read it
+        */
+       SWRAP_LOCK_SI(parent_si);
+
        /*
         * assume out sockaddr have the same size as the in parent
         * socket family
         */
        in_addr.sa_socklen = socket_length(parent_si->family);
        if (in_addr.sa_socklen <= 0) {
+               SWRAP_UNLOCK_SI(parent_si);
                errno = EINVAL;
                return -1;
        }
 
+       SWRAP_UNLOCK_SI(parent_si);
+
+#ifdef HAVE_ACCEPT4
+       ret = libc_accept4(s, &un_addr.sa.s, &un_addr.sa_socklen, flags);
+#else
+       UNUSED(flags);
        ret = libc_accept(s, &un_addr.sa.s, &un_addr.sa_socklen);
+#endif
        if (ret == -1) {
                if (errno == ENOTSOCK) {
                        /* Remove stale fds */
@@ -2620,6 +3365,8 @@ static int swrap_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
 
        fd = ret;
 
+       SWRAP_LOCK_SI(parent_si);
+
        ret = sockaddr_convert_from_un(parent_si,
                                       &un_addr.sa.un,
                                       un_addr.sa_socklen,
@@ -2627,28 +3374,12 @@ static int swrap_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
                                       &in_addr.sa.s,
                                       &in_addr.sa_socklen);
        if (ret == -1) {
+               SWRAP_UNLOCK_SI(parent_si);
                close(fd);
                return ret;
        }
 
-       child_si = (struct socket_info *)calloc(1, sizeof(struct socket_info));
-       if (child_si == NULL) {
-               close(fd);
-               errno = ENOMEM;
-               return -1;
-       }
-
-       child_fi = (struct socket_info_fd *)calloc(1, sizeof(struct socket_info_fd));
-       if (child_fi == NULL) {
-               free(child_si);
-               close(fd);
-               errno = ENOMEM;
-               return -1;
-       }
-
-       child_fi->fd = fd;
-
-       SWRAP_DLIST_ADD(child_si->fds, child_fi);
+       child_si = &new_si;
 
        child_si->family = parent_si->family;
        child_si->type = parent_si->type;
@@ -2657,6 +3388,8 @@ static int swrap_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
        child_si->is_server = 1;
        child_si->connected = 1;
 
+       SWRAP_UNLOCK_SI(parent_si);
+
        child_si->peername = (struct swrap_address) {
                .sa_socklen = in_addr.sa_socklen,
        };
@@ -2674,8 +3407,6 @@ static int swrap_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
                               &un_my_addr.sa.s,
                               &un_my_addr.sa_socklen);
        if (ret == -1) {
-               free(child_fi);
-               free(child_si);
                close(fd);
                return ret;
        }
@@ -2687,8 +3418,6 @@ static int swrap_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
                                       &in_my_addr.sa.s,
                                       &in_my_addr.sa_socklen);
        if (ret == -1) {
-               free(child_fi);
-               free(child_si);
                close(fd);
                return ret;
        }
@@ -2702,24 +3431,39 @@ static int swrap_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
        };
        memcpy(&child_si->myname.sa.ss, &in_my_addr.sa.ss, in_my_addr.sa_socklen);
 
-       SWRAP_DLIST_ADD(sockets, child_si);
+       idx = swrap_create_socket(&new_si, fd);
+       if (idx == -1) {
+               close (fd);
+               return -1;
+       }
 
        if (addr != NULL) {
-               swrap_pcap_dump_packet(child_si, addr, SWRAP_ACCEPT_SEND, NULL, 0);
-               swrap_pcap_dump_packet(child_si, addr, SWRAP_ACCEPT_RECV, NULL, 0);
-               swrap_pcap_dump_packet(child_si, addr, SWRAP_ACCEPT_ACK, NULL, 0);
+               struct socket_info *si = swrap_get_socket_info(idx);
+
+               SWRAP_LOCK_SI(si);
+               swrap_pcap_dump_packet(si, addr, SWRAP_ACCEPT_SEND, NULL, 0);
+               swrap_pcap_dump_packet(si, addr, SWRAP_ACCEPT_RECV, NULL, 0);
+               swrap_pcap_dump_packet(si, addr, SWRAP_ACCEPT_ACK, NULL, 0);
+               SWRAP_UNLOCK_SI(si);
        }
 
        return fd;
 }
 
+#ifdef HAVE_ACCEPT4
+int accept4(int s, struct sockaddr *addr, socklen_t *addrlen, int flags)
+{
+       return swrap_accept(s, addr, (socklen_t *)addrlen, flags);
+}
+#endif
+
 #ifdef HAVE_ACCEPT_PSOCKLEN_T
 int accept(int s, struct sockaddr *addr, Psocklen_t addrlen)
 #else
 int accept(int s, struct sockaddr *addr, socklen_t *addrlen)
 #endif
 {
-       return swrap_accept(s, addr, (socklen_t *)addrlen);
+       return swrap_accept(s, addr, (socklen_t *)addrlen, 0);
 }
 
 static int autobind_start_init;
@@ -2741,6 +3485,9 @@ static int swrap_auto_bind(int fd, struct socket_info *si, int family)
        int ret;
        int port;
        struct stat st;
+       char *swrap_dir = NULL;
+
+       swrap_mutex_lock(&autobind_start_mutex);
 
        if (autobind_start_init != 1) {
                autobind_start_init = 1;
@@ -2763,8 +3510,9 @@ static int swrap_auto_bind(int fd, struct socket_info *si, int family)
                        type = SOCKET_TYPE_CHAR_UDP;
                        break;
                default:
-                   errno = ESOCKTNOSUPPORT;
-                   return -1;
+                       errno = ESOCKTNOSUPPORT;
+                       ret = -1;
+                       goto done;
                }
 
                memset(&in, 0, sizeof(in));
@@ -2784,7 +3532,8 @@ static int swrap_auto_bind(int fd, struct socket_info *si, int family)
 
                if (si->family != family) {
                        errno = ENETUNREACH;
-                       return -1;
+                       ret = -1;
+                       goto done;
                }
 
                switch (si->type) {
@@ -2796,7 +3545,8 @@ static int swrap_auto_bind(int fd, struct socket_info *si, int family)
                        break;
                default:
                        errno = ESOCKTNOSUPPORT;
-                       return -1;
+                       ret = -1;
+                       goto done;
                }
 
                memset(&in6, 0, sizeof(in6));
@@ -2813,22 +3563,27 @@ static int swrap_auto_bind(int fd, struct socket_info *si, int family)
 #endif
        default:
                errno = ESOCKTNOSUPPORT;
-               return -1;
+               ret = -1;
+               goto done;
        }
 
        if (autobind_start > 60000) {
                autobind_start = 10000;
        }
 
+       swrap_dir = socket_wrapper_dir();
+
        for (i = 0; i < SOCKET_MAX_SOCKETS; i++) {
                port = autobind_start + i;
                snprintf(un_addr.sa.un.sun_path, sizeof(un_addr.sa.un.sun_path),
-                        "%s/"SOCKET_FORMAT, socket_wrapper_dir(),
-                        type, socket_wrapper_default_iface(), port);
+                        "%s/"SOCKET_FORMAT, swrap_dir, type,
+                        socket_wrapper_default_iface(), port);
                if (stat(un_addr.sa.un.sun_path, &st) == 0) continue;
 
                ret = libc_bind(fd, &un_addr.sa.s, un_addr.sa_socklen);
-               if (ret == -1) return ret;
+               if (ret == -1) {
+                       goto done;
+               }
 
                si->un_addr = un_addr.sa.un;
 
@@ -2844,13 +3599,19 @@ static int swrap_auto_bind(int fd, struct socket_info *si, int family)
                                           socket_wrapper_default_iface(),
                                           0);
                errno = ENFILE;
-               return -1;
+               ret = -1;
+               goto done;
        }
 
        si->family = family;
        set_port(si->family, port, &si->myname);
 
-       return 0;
+       ret = 0;
+
+done:
+       SAFE_FREE(swrap_dir);
+       swrap_mutex_unlock(&autobind_start_mutex);
+       return ret;
 }
 
 /****************************************************************************
@@ -2871,23 +3632,31 @@ static int swrap_connect(int s, const struct sockaddr *serv_addr,
                return libc_connect(s, serv_addr, addrlen);
        }
 
+       SWRAP_LOCK_SI(si);
+
        if (si->bound == 0) {
                ret = swrap_auto_bind(s, si, serv_addr->sa_family);
-               if (ret == -1) return -1;
+               if (ret == -1) {
+                       goto done;
+               }
        }
 
        if (si->family != serv_addr->sa_family) {
                errno = EINVAL;
-               return -1;
+               ret = -1;
+               goto done;
        }
 
        ret = sockaddr_convert_to_un(si, serv_addr,
                                     addrlen, &un_addr.sa.un, 0, &bcast);
-       if (ret == -1) return -1;
+       if (ret == -1) {
+               goto done;
+       }
 
        if (bcast) {
                errno = ENETUNREACH;
-               return -1;
+               ret = -1;
+               goto done;
        }
 
        if (si->type == SOCK_DGRAM) {
@@ -2947,6 +3716,8 @@ static int swrap_connect(int s, const struct sockaddr *serv_addr,
                swrap_pcap_dump_packet(si, serv_addr, SWRAP_CONNECT_UNREACH, NULL, 0);
        }
 
+done:
+       SWRAP_UNLOCK_SI(si);
        return ret;
 }
 
@@ -2975,6 +3746,8 @@ static int swrap_bind(int s, const struct sockaddr *myaddr, socklen_t addrlen)
                return libc_bind(s, myaddr, addrlen);
        }
 
+       SWRAP_LOCK_SI(si);
+
        switch (si->family) {
        case AF_INET: {
                const struct sockaddr_in *sin;
@@ -3022,14 +3795,16 @@ static int swrap_bind(int s, const struct sockaddr *myaddr, socklen_t addrlen)
 
        if (bind_error != 0) {
                errno = bind_error;
-               return -1;
+               ret = -1;
+               goto out;
        }
 
 #if 0 /* FIXME */
        in_use = check_addr_port_in_use(myaddr, addrlen);
        if (in_use) {
                errno = EADDRINUSE;
-               return -1;
+               ret = -1;
+               goto out;
        }
 #endif
 
@@ -3042,7 +3817,9 @@ static int swrap_bind(int s, const struct sockaddr *myaddr, socklen_t addrlen)
                                     &un_addr.sa.un,
                                     1,
                                     &si->bcast);
-       if (ret == -1) return -1;
+       if (ret == -1) {
+               goto out;
+       }
 
        unlink(un_addr.sa.un.sun_path);
 
@@ -3056,6 +3833,9 @@ static int swrap_bind(int s, const struct sockaddr *myaddr, socklen_t addrlen)
                si->bound = 1;
        }
 
+out:
+       SWRAP_UNLOCK_SI(si);
+
        return ret;
 }
 
@@ -3159,16 +3939,21 @@ static int swrap_listen(int s, int backlog)
                return libc_listen(s, backlog);
        }
 
+       SWRAP_LOCK_SI(si);
+
        if (si->bound == 0) {
                ret = swrap_auto_bind(s, si, si->family);
                if (ret == -1) {
                        errno = EADDRINUSE;
-                       return ret;
+                       goto out;
                }
        }
 
        ret = libc_listen(s, backlog);
 
+out:
+       SWRAP_UNLOCK_SI(si);
+
        return ret;
 }
 
@@ -3200,6 +3985,31 @@ FILE *fopen(const char *name, const char *mode)
        return swrap_fopen(name, mode);
 }
 
+/****************************************************************************
+ *   FOPEN64
+ ***************************************************************************/
+
+#ifdef HAVE_FOPEN64
+static FILE *swrap_fopen64(const char *name, const char *mode)
+{
+       FILE *fp;
+
+       fp = libc_fopen64(name, mode);
+       if (fp != NULL) {
+               int fd = fileno(fp);
+
+               swrap_remove_stale(fd);
+       }
+
+       return fp;
+}
+
+FILE *fopen64(const char *name, const char *mode)
+{
+       return swrap_fopen64(name, mode);
+}
+#endif /* HAVE_FOPEN64 */
+
 /****************************************************************************
  *   OPEN
  ***************************************************************************/
@@ -3233,6 +4043,75 @@ int open(const char *pathname, int flags, ...)
        return fd;
 }
 
+/****************************************************************************
+ *   OPEN64
+ ***************************************************************************/
+
+#ifdef HAVE_OPEN64
+static int swrap_vopen64(const char *pathname, int flags, va_list ap)
+{
+       int ret;
+
+       ret = libc_vopen64(pathname, flags, ap);
+       if (ret != -1) {
+               /*
+                * There are methods for closing descriptors (libc-internal code
+                * paths, direct syscalls) which close descriptors in ways that
+                * we can't intercept, so try to recover when we notice that
+                * that's happened
+                */
+               swrap_remove_stale(ret);
+       }
+       return ret;
+}
+
+int open64(const char *pathname, int flags, ...)
+{
+       va_list ap;
+       int fd;
+
+       va_start(ap, flags);
+       fd = swrap_vopen64(pathname, flags, ap);
+       va_end(ap);
+
+       return fd;
+}
+#endif /* HAVE_OPEN64 */
+
+/****************************************************************************
+ *   OPENAT
+ ***************************************************************************/
+
+static int swrap_vopenat(int dirfd, const char *path, int flags, va_list ap)
+{
+       int ret;
+
+       ret = libc_vopenat(dirfd, path, flags, ap);
+       if (ret != -1) {
+               /*
+                * There are methods for closing descriptors (libc-internal code
+                * paths, direct syscalls) which close descriptors in ways that
+                * we can't intercept, so try to recover when we notice that
+                * that's happened
+                */
+               swrap_remove_stale(ret);
+       }
+
+       return ret;
+}
+
+int openat(int dirfd, const char *path, int flags, ...)
+{
+       va_list ap;
+       int fd;
+
+       va_start(ap, flags);
+       fd = swrap_vopenat(dirfd, path, flags, ap);
+       va_end(ap);
+
+       return fd;
+}
+
 /****************************************************************************
  *   GETPEERNAME
  ***************************************************************************/
@@ -3241,26 +4120,34 @@ static int swrap_getpeername(int s, struct sockaddr *name, socklen_t *addrlen)
 {
        struct socket_info *si = find_socket_info(s);
        socklen_t len;
+       int ret = -1;
 
        if (!si) {
                return libc_getpeername(s, name, addrlen);
        }
 
+       SWRAP_LOCK_SI(si);
+
        if (si->peername.sa_socklen == 0)
        {
                errno = ENOTCONN;
-               return -1;
+               goto out;
        }
 
        len = MIN(*addrlen, si->peername.sa_socklen);
        if (len == 0) {
-               return 0;
+               ret = 0;
+               goto out;
        }
 
        memcpy(name, &si->peername.sa.ss, len);
        *addrlen = si->peername.sa_socklen;
 
-       return 0;
+       ret = 0;
+out:
+       SWRAP_UNLOCK_SI(si);
+
+       return ret;
 }
 
 #ifdef HAVE_ACCEPT_PSOCKLEN_T
@@ -3280,20 +4167,28 @@ static int swrap_getsockname(int s, struct sockaddr *name, socklen_t *addrlen)
 {
        struct socket_info *si = find_socket_info(s);
        socklen_t len;
+       int ret = -1;
 
        if (!si) {
                return libc_getsockname(s, name, addrlen);
        }
 
+       SWRAP_LOCK_SI(si);
+
        len = MIN(*addrlen, si->myname.sa_socklen);
        if (len == 0) {
-               return 0;
+               ret = 0;
+               goto out;
        }
 
        memcpy(name, &si->myname.sa.ss, len);
        *addrlen = si->myname.sa_socklen;
 
-       return 0;
+       ret = 0;
+out:
+       SWRAP_UNLOCK_SI(si);
+
+       return ret;
 }
 
 #ifdef HAVE_ACCEPT_PSOCKLEN_T
@@ -3319,6 +4214,7 @@ static int swrap_getsockopt(int s, int level, int optname,
                            void *optval, socklen_t *optlen)
 {
        struct socket_info *si = find_socket_info(s);
+       int ret;
 
        if (!si) {
                return libc_getsockopt(s,
@@ -3328,6 +4224,8 @@ static int swrap_getsockopt(int s, int level, int optname,
                                       optlen);
        }
 
+       SWRAP_LOCK_SI(si);
+
        if (level == SOL_SOCKET) {
                switch (optname) {
 #ifdef SO_DOMAIN
@@ -3335,12 +4233,14 @@ static int swrap_getsockopt(int s, int level, int optname,
                        if (optval == NULL || optlen == NULL ||
                            *optlen < (socklen_t)sizeof(int)) {
                                errno = EINVAL;
-                               return -1;
+                               ret = -1;
+                               goto done;
                        }
 
                        *optlen = sizeof(int);
                        *(int *)optval = si->family;
-                       return 0;
+                       ret = 0;
+                       goto done;
 #endif /* SO_DOMAIN */
 
 #ifdef SO_PROTOCOL
@@ -3348,29 +4248,34 @@ static int swrap_getsockopt(int s, int level, int optname,
                        if (optval == NULL || optlen == NULL ||
                            *optlen < (socklen_t)sizeof(int)) {
                                errno = EINVAL;
-                               return -1;
+                               ret = -1;
+                               goto done;
                        }
 
                        *optlen = sizeof(int);
                        *(int *)optval = si->protocol;
-                       return 0;
+                       ret = 0;
+                       goto done;
 #endif /* SO_PROTOCOL */
                case SO_TYPE:
                        if (optval == NULL || optlen == NULL ||
                            *optlen < (socklen_t)sizeof(int)) {
                                errno = EINVAL;
-                               return -1;
+                               ret = -1;
+                               goto done;
                        }
 
                        *optlen = sizeof(int);
                        *(int *)optval = si->type;
-                       return 0;
+                       ret = 0;
+                       goto done;
                default:
-                       return libc_getsockopt(s,
-                                              level,
-                                              optname,
-                                              optval,
-                                              optlen);
+                       ret = libc_getsockopt(s,
+                                             level,
+                                             optname,
+                                             optval,
+                                             optlen);
+                       goto done;
                }
        } else if (level == IPPROTO_TCP) {
                switch (optname) {
@@ -3384,13 +4289,15 @@ static int swrap_getsockopt(int s, int level, int optname,
                        if (optval == NULL || optlen == NULL ||
                            *optlen < (socklen_t)sizeof(int)) {
                                errno = EINVAL;
-                               return -1;
+                               ret = -1;
+                               goto done;
                        }
 
                        *optlen = sizeof(int);
                        *(int *)optval = si->tcp_nodelay;
 
-                       return 0;
+                       ret = 0;
+                       goto done;
 #endif /* TCP_NODELAY */
                default:
                        break;
@@ -3398,7 +4305,11 @@ static int swrap_getsockopt(int s, int level, int optname,
        }
 
        errno = ENOPROTOOPT;
-       return -1;
+       ret = -1;
+
+done:
+       SWRAP_UNLOCK_SI(si);
+       return ret;
 }
 
 #ifdef HAVE_ACCEPT_PSOCKLEN_T
@@ -3418,6 +4329,7 @@ static int swrap_setsockopt(int s, int level, int optname,
                            const void *optval, socklen_t optlen)
 {
        struct socket_info *si = find_socket_info(s);
+       int ret;
 
        if (!si) {
                return libc_setsockopt(s,
@@ -3433,7 +4345,11 @@ static int swrap_setsockopt(int s, int level, int optname,
                                       optname,
                                       optval,
                                       optlen);
-       } else if (level == IPPROTO_TCP) {
+       }
+
+       SWRAP_LOCK_SI(si);
+
+       if (level == IPPROTO_TCP) {
                switch (optname) {
 #ifdef TCP_NODELAY
                case TCP_NODELAY: {
@@ -3446,17 +4362,20 @@ static int swrap_setsockopt(int s, int level, int optname,
                        if (optval == NULL || optlen == 0 ||
                            optlen < (socklen_t)sizeof(int)) {
                                errno = EINVAL;
-                               return -1;
+                               ret = -1;
+                               goto done;
                        }
 
                        i = *discard_const_p(int, optval);
                        if (i != 0 && i != 1) {
                                errno = EINVAL;
-                               return -1;
+                               ret = -1;
+                               goto done;
                        }
                        si->tcp_nodelay = i;
 
-                       return 0;
+                       ret = 0;
+                       goto done;
                }
 #endif /* TCP_NODELAY */
                default:
@@ -3473,7 +4392,8 @@ static int swrap_setsockopt(int s, int level, int optname,
                        }
 #endif /* IP_PKTINFO */
                }
-               return 0;
+               ret = 0;
+               goto done;
 #ifdef HAVE_IPV6
        case AF_INET6:
                if (level == IPPROTO_IPV6) {
@@ -3483,12 +4403,18 @@ static int swrap_setsockopt(int s, int level, int optname,
                        }
 #endif /* IPV6_PKTINFO */
                }
-               return 0;
+               ret = 0;
+               goto done;
 #endif
        default:
                errno = ENOPROTOOPT;
-               return -1;
+               ret = -1;
+               goto done;
        }
+
+done:
+       SWRAP_UNLOCK_SI(si);
+       return ret;
 }
 
 int setsockopt(int s, int level, int optname,
@@ -3512,6 +4438,8 @@ static int swrap_vioctl(int s, unsigned long int r, va_list va)
                return libc_vioctl(s, r, va);
        }
 
+       SWRAP_LOCK_SI(si);
+
        va_copy(ap, va);
 
        rc = libc_vioctl(s, r, va);
@@ -3530,6 +4458,7 @@ static int swrap_vioctl(int s, unsigned long int r, va_list va)
 
        va_end(ap);
 
+       SWRAP_UNLOCK_SI(si);
        return rc;
 }
 
@@ -3835,7 +4764,7 @@ static ssize_t swrap_sendmsg_before(int fd,
                                    int *bcast)
 {
        size_t i, len = 0;
-       ssize_t ret;
+       ssize_t ret = -1;
 
        if (to_un) {
                *to_un = NULL;
@@ -3847,13 +4776,15 @@ static ssize_t swrap_sendmsg_before(int fd,
                *bcast = 0;
        }
 
+       SWRAP_LOCK_SI(si);
+
        switch (si->type) {
        case SOCK_STREAM: {
                unsigned long mtu;
 
                if (!si->connected) {
                        errno = ENOTCONN;
-                       return -1;
+                       goto out;
                }
 
                if (msg->msg_iovlen == 0) {
@@ -3864,6 +4795,11 @@ static ssize_t swrap_sendmsg_before(int fd,
                for (i = 0; i < (size_t)msg->msg_iovlen; i++) {
                        size_t nlen;
                        nlen = len + msg->msg_iov[i].iov_len;
+                       if (nlen < len) {
+                               /* overflow */
+                               errno = EMSGSIZE;
+                               goto out;
+                       }
                        if (nlen > mtu) {
                                break;
                        }
@@ -3880,9 +4816,15 @@ static ssize_t swrap_sendmsg_before(int fd,
        }
        case SOCK_DGRAM:
                if (si->connected) {
-                       if (msg->msg_name) {
-                               errno = EISCONN;
-                               return -1;
+                       if (msg->msg_name != NULL) {
+                               /*
+                                * We are dealing with unix sockets and if we
+                                * are connected, we should only talk to the
+                                * connected unix path. Using the fd to send
+                                * to another server would be hard to achieve.
+                                */
+                               msg->msg_name = NULL;
+                               msg->msg_namelen = 0;
                        }
                } else {
                        const struct sockaddr *msg_name;
@@ -3890,13 +4832,15 @@ static ssize_t swrap_sendmsg_before(int fd,
 
                        if (msg_name == NULL) {
                                errno = ENOTCONN;
-                               return -1;
+                               goto out;
                        }
 
 
                        ret = sockaddr_convert_to_un(si, msg_name, msg->msg_namelen,
                                                     tmp_un, 0, bcast);
-                       if (ret == -1) return -1;
+                       if (ret == -1) {
+                               goto out;
+                       }
 
                        if (to_un) {
                                *to_un = tmp_un;
@@ -3911,13 +4855,14 @@ static ssize_t swrap_sendmsg_before(int fd,
                if (si->bound == 0) {
                        ret = swrap_auto_bind(fd, si, si->family);
                        if (ret == -1) {
+                               SWRAP_UNLOCK_SI(si);
                                if (errno == ENOTSOCK) {
                                        swrap_remove_stale(fd);
-                                       return -ENOTSOCK;
+                                       ret = -ENOTSOCK;
                                } else {
                                        SWRAP_LOG(SWRAP_LOG_ERROR, "swrap_sendmsg_before failed");
-                                       return -1;
                                }
+                               return ret;
                        }
                }
 
@@ -3931,7 +4876,9 @@ static ssize_t swrap_sendmsg_before(int fd,
                                             tmp_un,
                                             0,
                                             NULL);
-               if (ret == -1) return -1;
+               if (ret == -1) {
+                       goto out;
+               }
 
                ret = libc_connect(fd,
                                   (struct sockaddr *)(void *)tmp_un,
@@ -3943,14 +4890,14 @@ static ssize_t swrap_sendmsg_before(int fd,
                }
 
                if (ret == -1) {
-                       return ret;
+                       goto out;
                }
 
                si->defer_connect = 0;
                break;
        default:
                errno = EHOSTUNREACH;
-               return -1;
+               goto out;
        }
 
 #ifdef HAVE_STRUCT_MSGHDR_MSG_CONTROL
@@ -3961,7 +4908,7 @@ static ssize_t swrap_sendmsg_before(int fd,
                ret = swrap_sendmsg_filter_cmsghdr(msg, &cmbuf, &cmlen);
                if (ret < 0) {
                        free(cmbuf);
-                       return -1;
+                       goto out;
                }
 
                if (cmlen == 0) {
@@ -3975,7 +4922,11 @@ static ssize_t swrap_sendmsg_before(int fd,
        }
 #endif
 
-       return 0;
+       ret = 0;
+out:
+       SWRAP_UNLOCK_SI(si);
+
+       return ret;
 }
 
 static void swrap_sendmsg_after(int fd,
@@ -4029,6 +4980,8 @@ static void swrap_sendmsg_after(int fd,
        }
        len = ofs;
 
+       SWRAP_LOCK_SI(si);
+
        switch (si->type) {
        case SOCK_STREAM:
                if (ret == -1) {
@@ -4052,6 +5005,8 @@ static void swrap_sendmsg_after(int fd,
                break;
        }
 
+       SWRAP_UNLOCK_SI(si);
+
        free(buf);
        errno = saved_errno;
 }
@@ -4062,7 +5017,9 @@ static int swrap_recvmsg_before(int fd,
                                struct iovec *tmp_iov)
 {
        size_t i, len = 0;
-       ssize_t ret;
+       int ret = -1;
+
+       SWRAP_LOCK_SI(si);
 
        (void)fd; /* unused */
 
@@ -4071,7 +5028,7 @@ static int swrap_recvmsg_before(int fd,
                unsigned int mtu;
                if (!si->connected) {
                        errno = ENOTCONN;
-                       return -1;
+                       goto out;
                }
 
                if (msg->msg_iovlen == 0) {
@@ -4099,7 +5056,7 @@ static int swrap_recvmsg_before(int fd,
        case SOCK_DGRAM:
                if (msg->msg_name == NULL) {
                        errno = EINVAL;
-                       return -1;
+                       goto out;
                }
 
                if (msg->msg_iovlen == 0) {
@@ -4109,6 +5066,7 @@ static int swrap_recvmsg_before(int fd,
                if (si->bound == 0) {
                        ret = swrap_auto_bind(fd, si, si->family);
                        if (ret == -1) {
+                               SWRAP_UNLOCK_SI(si);
                                /*
                                 * When attempting to read or write to a
                                 * descriptor, if an underlying autobind fails
@@ -4117,21 +5075,25 @@ static int swrap_recvmsg_before(int fd,
                                 */
                                if (errno == ENOTSOCK) {
                                        swrap_remove_stale(fd);
-                                       return -ENOTSOCK;
+                                       ret = -ENOTSOCK;
                                } else {
                                        SWRAP_LOG(SWRAP_LOG_ERROR,
                                                  "swrap_recvmsg_before failed");
-                                       return -1;
                                }
+                               return ret;
                        }
                }
                break;
        default:
                errno = EHOSTUNREACH;
-               return -1;
+               goto out;
        }
 
-       return 0;
+       ret = 0;
+out:
+       SWRAP_UNLOCK_SI(si);
+
+       return ret;
 }
 
 static int swrap_recvmsg_after(int fd,
@@ -4163,6 +5125,8 @@ static int swrap_recvmsg_after(int fd,
                avail += msg->msg_iov[i].iov_len;
        }
 
+       SWRAP_LOCK_SI(si);
+
        /* Convert the socket address before we leave */
        if (si->type == SOCK_DGRAM && un_addr != NULL) {
                rc = sockaddr_convert_from_un(si,
@@ -4191,6 +5155,7 @@ static int swrap_recvmsg_after(int fd,
        buf = (uint8_t *)malloc(remain);
        if (buf == NULL) {
                /* we just not capture the packet */
+               SWRAP_UNLOCK_SI(si);
                errno = saved_errno;
                return -1;
        }
@@ -4248,11 +5213,13 @@ done:
            msg->msg_control != NULL) {
                rc = swrap_msghdr_add_socket_info(si, msg);
                if (rc < 0) {
+                       SWRAP_UNLOCK_SI(si);
                        return -1;
                }
        }
 #endif
 
+       SWRAP_UNLOCK_SI(si);
        return rc;
 }
 
@@ -4379,7 +5346,7 @@ static ssize_t swrap_sendto(int s, const void *buf, size_t len, int flags,
        msg.msg_namelen = tolen;       /* size of address */
        msg.msg_iov = &tmp;            /* scatter/gather array */
        msg.msg_iovlen = 1;            /* # elements in msg_iov */
-#if HAVE_STRUCT_MSGHDR_MSG_CONTROL
+#ifdef HAVE_STRUCT_MSGHDR_MSG_CONTROL
        msg.msg_control = NULL;        /* ancillary data, see below */
        msg.msg_controllen = 0;        /* ancillary data buffer len */
        msg.msg_flags = 0;             /* flags on received message */
@@ -4405,14 +5372,16 @@ static ssize_t swrap_sendto(int s, const void *buf, size_t len, int flags,
                unsigned int iface;
                unsigned int prt = ntohs(((const struct sockaddr_in *)(const void *)to)->sin_port);
                char type;
+               char *swrap_dir = NULL;
 
                type = SOCKET_TYPE_CHAR_UDP;
 
+               swrap_dir = socket_wrapper_dir();
+
                for(iface=0; iface <= MAX_WRAPPED_INTERFACES; iface++) {
                        snprintf(un_addr.sa.un.sun_path,
                                 sizeof(un_addr.sa.un.sun_path),
-                                "%s/"SOCKET_FORMAT,
-                                socket_wrapper_dir(), type, iface, prt);
+                                "%s/"SOCKET_FORMAT, swrap_dir, type, iface, prt);
                        if (stat(un_addr.sa.un.sun_path, &st) != 0) continue;
 
                        /* ignore the any errors in broadcast sends */
@@ -4424,17 +5393,39 @@ static ssize_t swrap_sendto(int s, const void *buf, size_t len, int flags,
                                    un_addr.sa_socklen);
                }
 
+               SAFE_FREE(swrap_dir);
+
+               SWRAP_LOCK_SI(si);
+
                swrap_pcap_dump_packet(si, to, SWRAP_SENDTO, buf, len);
 
+               SWRAP_UNLOCK_SI(si);
+
                return len;
        }
 
-       ret = libc_sendto(s,
-                         buf,
-                         len,
-                         flags,
-                         (struct sockaddr *)msg.msg_name,
-                         msg.msg_namelen);
+       SWRAP_LOCK_SI(si);
+       /*
+        * If it is a dgram socket and we are connected, don't include the
+        * 'to' address.
+        */
+       if (si->type == SOCK_DGRAM && si->connected) {
+               ret = libc_sendto(s,
+                                 buf,
+                                 len,
+                                 flags,
+                                 NULL,
+                                 0);
+       } else {
+               ret = libc_sendto(s,
+                                 buf,
+                                 len,
+                                 flags,
+                                 (struct sockaddr *)msg.msg_name,
+                                 msg.msg_namelen);
+       }
+
+       SWRAP_UNLOCK_SI(si);
 
        swrap_sendmsg_after(s, si, &msg, to, ret);
 
@@ -4590,7 +5581,7 @@ static ssize_t swrap_write(int s, const void *buf, size_t len)
        msg.msg_namelen = 0;           /* size of address */
        msg.msg_iov = &tmp;            /* scatter/gather array */
        msg.msg_iovlen = 1;            /* # elements in msg_iov */
-#if HAVE_STRUCT_MSGHDR_MSG_CONTROL
+#ifdef HAVE_STRUCT_MSGHDR_MSG_CONTROL
        msg.msg_control = NULL;        /* ancillary data, see below */
        msg.msg_controllen = 0;        /* ancillary data buffer len */
        msg.msg_flags = 0;             /* flags on received message */
@@ -4641,7 +5632,7 @@ static ssize_t swrap_send(int s, const void *buf, size_t len, int flags)
        msg.msg_namelen = 0;           /* size of address */
        msg.msg_iov = &tmp;            /* scatter/gather array */
        msg.msg_iovlen = 1;            /* # elements in msg_iov */
-#if HAVE_STRUCT_MSGHDR_MSG_CONTROL
+#ifdef HAVE_STRUCT_MSGHDR_MSG_CONTROL
        msg.msg_control = NULL;        /* ancillary data, see below */
        msg.msg_controllen = 0;        /* ancillary data buffer len */
        msg.msg_flags = 0;             /* flags on received message */
@@ -4767,6 +5758,8 @@ static ssize_t swrap_recvmsg(int s, struct msghdr *omsg, int flags)
 #endif
        omsg->msg_iovlen = msg.msg_iovlen;
 
+       SWRAP_LOCK_SI(si);
+
        /*
         * From the manpage:
         *
@@ -4786,6 +5779,8 @@ static ssize_t swrap_recvmsg(int s, struct msghdr *omsg, int flags)
                omsg->msg_namelen = msg.msg_namelen;
        }
 
+       SWRAP_UNLOCK_SI(si);
+
        return ret;
 }
 
@@ -4821,12 +5816,17 @@ static ssize_t swrap_sendmsg(int s, const struct msghdr *omsg, int flags)
 
        ZERO_STRUCT(msg);
 
+       SWRAP_LOCK_SI(si);
+
        if (si->connected == 0) {
                msg.msg_name = omsg->msg_name;             /* optional address */
                msg.msg_namelen = omsg->msg_namelen;       /* size of address */
        }
        msg.msg_iov = omsg->msg_iov;               /* scatter/gather array */
        msg.msg_iovlen = omsg->msg_iovlen;         /* # elements in msg_iov */
+
+       SWRAP_UNLOCK_SI(si);
+
 #ifdef HAVE_STRUCT_MSGHDR_MSG_CONTROL
        if (msg.msg_controllen > 0 && msg.msg_control != NULL) {
                /* omsg is a const so use a local buffer for modifications */
@@ -4855,6 +5855,7 @@ static ssize_t swrap_sendmsg(int s, const struct msghdr *omsg, int flags)
                off_t ofs = 0;
                size_t avail = 0;
                size_t remain;
+               char *swrap_dir = NULL;
 
                for (i = 0; i < (size_t)msg.msg_iovlen; i++) {
                        avail += msg.msg_iov[i].iov_len;
@@ -4880,9 +5881,11 @@ static ssize_t swrap_sendmsg(int s, const struct msghdr *omsg, int flags)
 
                type = SOCKET_TYPE_CHAR_UDP;
 
+               swrap_dir = socket_wrapper_dir();
+
                for(iface=0; iface <= MAX_WRAPPED_INTERFACES; iface++) {
                        snprintf(un_addr.sun_path, sizeof(un_addr.sun_path), "%s/"SOCKET_FORMAT,
-                                socket_wrapper_dir(), type, iface, prt);
+                                swrap_dir, type, iface, prt);
                        if (stat(un_addr.sun_path, &st) != 0) continue;
 
                        msg.msg_name = &un_addr;           /* optional address */
@@ -4892,9 +5895,15 @@ static ssize_t swrap_sendmsg(int s, const struct msghdr *omsg, int flags)
                        libc_sendmsg(s, &msg, flags);
                }
 
+               SAFE_FREE(swrap_dir);
+
+               SWRAP_LOCK_SI(si);
+
                swrap_pcap_dump_packet(si, to, SWRAP_SENDTO, buf, len);
                free(buf);
 
+               SWRAP_UNLOCK_SI(si);
+
                return len;
        }
 
@@ -4992,7 +6001,7 @@ static ssize_t swrap_writev(int s, const struct iovec *vector, int count)
        msg.msg_namelen = 0;           /* size of address */
        msg.msg_iov = discard_const_p(struct iovec, vector); /* scatter/gather array */
        msg.msg_iovlen = count;        /* # elements in msg_iov */
-#if HAVE_STRUCT_MSGHDR_MSG_CONTROL
+#ifdef HAVE_STRUCT_MSGHDR_MSG_CONTROL
        msg.msg_control = NULL;        /* ancillary data, see below */
        msg.msg_controllen = 0;        /* ancillary data buffer len */
        msg.msg_flags = 0;             /* flags on received message */
@@ -5024,35 +6033,38 @@ ssize_t writev(int s, const struct iovec *vector, int count)
 
 static int swrap_close(int fd)
 {
-       struct socket_info *si = find_socket_info(fd);
-       struct socket_info_fd *fi;
+       struct socket_info *si = NULL;
+       int si_index;
        int ret;
 
-       if (!si) {
+       swrap_mutex_lock(&socket_reset_mutex);
+
+       si_index = find_socket_info_index(fd);
+       if (si_index == -1) {
+               swrap_mutex_unlock(&socket_reset_mutex);
                return libc_close(fd);
        }
 
-       for (fi = si->fds; fi; fi = fi->next) {
-               if (fi->fd == fd) {
-                       SWRAP_DLIST_REMOVE(si->fds, fi);
-                       free(fi);
-                       break;
-               }
-       }
+       reset_socket_info_index(fd);
+
+       si = swrap_get_socket_info(si_index);
+
+       swrap_mutex_lock(&first_free_mutex);
+       SWRAP_LOCK_SI(si);
+
+       ret = libc_close(fd);
+
+       swrap_dec_refcount(si);
 
-       if (si->fds) {
+       if (swrap_get_refcount(si) > 0) {
                /* there are still references left */
-               return libc_close(fd);
+               goto out;
        }
 
-       SWRAP_DLIST_REMOVE(sockets, si);
-
        if (si->myname.sa_socklen > 0 && si->peername.sa_socklen > 0) {
                swrap_pcap_dump_packet(si, NULL, SWRAP_CLOSE_SEND, NULL, 0);
        }
 
-       ret = libc_close(fd);
-
        if (si->myname.sa_socklen > 0 && si->peername.sa_socklen > 0) {
                swrap_pcap_dump_packet(si, NULL, SWRAP_CLOSE_RECV, NULL, 0);
                swrap_pcap_dump_packet(si, NULL, SWRAP_CLOSE_ACK, NULL, 0);
@@ -5061,7 +6073,14 @@ static int swrap_close(int fd)
        if (si->un_addr.sun_path[0] != '\0') {
                unlink(si->un_addr.sun_path);
        }
-       free(si);
+
+       swrap_set_next_free(si, first_free);
+       first_free = si_index;
+
+out:
+       SWRAP_UNLOCK_SI(si);
+       swrap_mutex_unlock(&first_free_mutex);
+       swrap_mutex_unlock(&socket_reset_mutex);
 
        return ret;
 }
@@ -5078,33 +6097,34 @@ int close(int fd)
 static int swrap_dup(int fd)
 {
        struct socket_info *si;
-       struct socket_info_fd *fi;
+       int dup_fd, idx;
 
-       si = find_socket_info(fd);
-
-       if (!si) {
+       idx = find_socket_info_index(fd);
+       if (idx == -1) {
                return libc_dup(fd);
        }
 
-       fi = (struct socket_info_fd *)calloc(1, sizeof(struct socket_info_fd));
-       if (fi == NULL) {
-               errno = ENOMEM;
-               return -1;
-       }
+       si = swrap_get_socket_info(idx);
 
-       fi->fd = libc_dup(fd);
-       if (fi->fd == -1) {
+       dup_fd = libc_dup(fd);
+       if (dup_fd == -1) {
                int saved_errno = errno;
-               free(fi);
                errno = saved_errno;
                return -1;
        }
 
+       SWRAP_LOCK_SI(si);
+
+       swrap_inc_refcount(si);
+
+       SWRAP_UNLOCK_SI(si);
+
        /* Make sure we don't have an entry for the fd */
-       swrap_remove_stale(fi->fd);
+       swrap_remove_stale(dup_fd);
+
+       set_socket_info_index(dup_fd, idx);
 
-       SWRAP_DLIST_ADD(si->fds, fi);
-       return fi->fd;
+       return dup_fd;
 }
 
 int dup(int fd)
@@ -5119,39 +6139,50 @@ int dup(int fd)
 static int swrap_dup2(int fd, int newfd)
 {
        struct socket_info *si;
-       struct socket_info_fd *fi;
+       int dup_fd, idx;
 
-       si = find_socket_info(fd);
-
-       if (!si) {
+       idx = find_socket_info_index(fd);
+       if (idx == -1) {
                return libc_dup2(fd, newfd);
        }
 
+       si = swrap_get_socket_info(idx);
+
+       if (fd == newfd) {
+               /*
+                * According to the manpage:
+                *
+                * "If oldfd is a valid file descriptor, and newfd has the same
+                * value as oldfd, then dup2() does nothing, and returns newfd."
+                */
+               return newfd;
+       }
+
        if (find_socket_info(newfd)) {
                /* dup2() does an implicit close of newfd, which we
                 * need to emulate */
                swrap_close(newfd);
        }
 
-       fi = (struct socket_info_fd *)calloc(1, sizeof(struct socket_info_fd));
-       if (fi == NULL) {
-               errno = ENOMEM;
-               return -1;
-       }
-
-       fi->fd = libc_dup2(fd, newfd);
-       if (fi->fd == -1) {
+       dup_fd = libc_dup2(fd, newfd);
+       if (dup_fd == -1) {
                int saved_errno = errno;
-               free(fi);
                errno = saved_errno;
                return -1;
        }
 
+       SWRAP_LOCK_SI(si);
+
+       swrap_inc_refcount(si);
+
+       SWRAP_UNLOCK_SI(si);
+
        /* Make sure we don't have an entry for the fd */
-       swrap_remove_stale(fi->fd);
+       swrap_remove_stale(dup_fd);
+
+       set_socket_info_index(dup_fd, idx);
 
-       SWRAP_DLIST_ADD(si->fds, fi);
-       return fi->fd;
+       return dup_fd;
 }
 
 int dup2(int fd, int newfd)
@@ -5165,39 +6196,37 @@ int dup2(int fd, int newfd)
 
 static int swrap_vfcntl(int fd, int cmd, va_list va)
 {
-       struct socket_info_fd *fi;
        struct socket_info *si;
-       int rc;
-
-       si = find_socket_info(fd);
-       if (si == NULL) {
-               rc = libc_vfcntl(fd, cmd, va);
+       int rc, dup_fd, idx;
 
-               return rc;
+       idx = find_socket_info_index(fd);
+       if (idx == -1) {
+               return libc_vfcntl(fd, cmd, va);
        }
 
+       si = swrap_get_socket_info(idx);
+
        switch (cmd) {
        case F_DUPFD:
-               fi = (struct socket_info_fd *)calloc(1, sizeof(struct socket_info_fd));
-               if (fi == NULL) {
-                       errno = ENOMEM;
-                       return -1;
-               }
-
-               fi->fd = libc_vfcntl(fd, cmd, va);
-               if (fi->fd == -1) {
+               dup_fd = libc_vfcntl(fd, cmd, va);
+               if (dup_fd == -1) {
                        int saved_errno = errno;
-                       free(fi);
                        errno = saved_errno;
                        return -1;
                }
 
+               SWRAP_LOCK_SI(si);
+
+               swrap_inc_refcount(si);
+
+               SWRAP_UNLOCK_SI(si);
+
                /* Make sure we don't have an entry for the fd */
-               swrap_remove_stale(fi->fd);
+               swrap_remove_stale(dup_fd);
 
-               SWRAP_DLIST_ADD(si->fds, fi);
+               set_socket_info_index(dup_fd, idx);
 
-               rc = fi->fd;
+               rc = dup_fd;
                break;
        default:
                rc = libc_vfcntl(fd, cmd, va);
@@ -5248,6 +6277,78 @@ int eventfd(int count, int flags)
 }
 #endif
 
+#ifdef HAVE_PLEDGE
+int pledge(const char *promises, const char *paths[])
+{
+       (void)promises; /* unused */
+       (void)paths; /* unused */
+
+       return 0;
+}
+#endif /* HAVE_PLEDGE */
+
+static void swrap_thread_prepare(void)
+{
+       /*
+        * This function should only be called here!!
+        *
+        * We bind all symobls to avoid deadlocks of the fork is
+        * interrupted by a signal handler using a symbol of this
+        * library.
+        */
+       swrap_bind_symbol_all();
+
+       SWRAP_LOCK_ALL;
+}
+
+static void swrap_thread_parent(void)
+{
+       SWRAP_UNLOCK_ALL;
+}
+
+static void swrap_thread_child(void)
+{
+       SWRAP_UNLOCK_ALL;
+}
+
+/****************************
+ * CONSTRUCTOR
+ ***************************/
+void swrap_constructor(void)
+{
+       int ret;
+
+       /*
+       * If we hold a lock and the application forks, then the child
+       * is not able to unlock the mutex and we are in a deadlock.
+       * This should prevent such deadlocks.
+       */
+       pthread_atfork(&swrap_thread_prepare,
+                      &swrap_thread_parent,
+                      &swrap_thread_child);
+
+       ret = socket_wrapper_init_mutex(&sockets_mutex);
+       if (ret != 0) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Failed to initialize pthread mutex");
+               exit(-1);
+       }
+
+       ret = socket_wrapper_init_mutex(&socket_reset_mutex);
+       if (ret != 0) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Failed to initialize pthread mutex");
+               exit(-1);
+       }
+
+       ret = socket_wrapper_init_mutex(&first_free_mutex);
+       if (ret != 0) {
+               SWRAP_LOG(SWRAP_LOG_ERROR,
+                         "Failed to initialize pthread mutex");
+               exit(-1);
+       }
+}
+
 /****************************
  * DESTRUCTOR
  ***************************/
@@ -5258,20 +6359,23 @@ int eventfd(int count, int flags)
  */
 void swrap_destructor(void)
 {
-       struct socket_info *s = sockets;
+       size_t i;
 
-       while (s != NULL) {
-               struct socket_info_fd *f = s->fds;
-               if (f != NULL) {
-                       swrap_close(f->fd);
+       if (socket_fds_idx != NULL) {
+               for (i = 0; i < socket_fds_max; ++i) {
+                       if (socket_fds_idx[i] != -1) {
+                               swrap_close(i);
+                       }
                }
-               s = sockets;
+               SAFE_FREE(socket_fds_idx);
        }
 
-       if (swrap.libc_handle != NULL) {
-               dlclose(swrap.libc_handle);
+       SAFE_FREE(sockets);
+
+       if (swrap.libc.handle != NULL) {
+               dlclose(swrap.libc.handle);
        }
-       if (swrap.libsocket_handle) {
-               dlclose(swrap.libsocket_handle);
+       if (swrap.libc.socket_handle) {
+               dlclose(swrap.libc.socket_handle);
        }
 }