#include <sys/wait.h>
#include <netinet/in.h>
+#include <sys/socket.h>
+#include <sys/un.h>
+#include <arpa/inet.h>
+
#define STDERRSTR_CONST(m) write(2,m,sizeof(m)-1)
#define STDERRSTR_STRING(m) write(2,m,strlen(m))
#define socket_args int domain, int type, int protocol
#define bind_args int fd, const struct sockaddr *addr, socklen_t addrlen
-#define WRAPS(X) \
- X(socket, (domain,type,protocol)) \
- X(bind, (fd,addr,addrlen))
+#define setsockopt_args int fd, int level, int optname, \
+ const void *optval, socklen_t optlen
+#define getsockname_args int fd, struct sockaddr *addr, socklen_t *addrlen
+#define WRAPS(X) \
+ X(socket, (domain,type,protocol)) \
+ X(bind, (fd,addr,addrlen)) \
+ X(setsockopt, (fd,level,optname,optval,optlen)) \
+ X(getsockname,(fd,addr,addrlen))
#define DEF_OLD(fn,args) \
typedef int fn##_fn_type(fn##_args); \
typedef struct{
int af;
- union {
- struct sockaddr_in v4;
- struct sockaddr_in6 v6;
- } bound;
} fdinfo;
static fdinfo **table;
static int tablesz;
return table[fd];
}
-static int chkaddr(fdinfo *ent,
- const struct sockaddr *addr, socklen_t addrlen) {
- if (addr->sa_family!=ent->af) { errno=EAFNOSUPPORT; return -1; }
- socklen_t expectlen;
+#define ADDRPORTSTRLEN (INET6_ADDRSTRLEN+1+5) /* not including nul */
+
+static int addrport2str(char buf[ADDRPORTSTRLEN+1],
+ const struct sockaddr *addr, socklen_t addrlen) {
+ const void *addrv=addr;
+ const void *iav;
+ const struct sockaddr_in *sin;
+ const struct sockaddr_in6 *sin6;
+ uint16_t port;
+ socklen_t el;
switch (addr->sa_family) {
- case AF_INET: expectlen=sizeof(ent->bound.v4); break;
- case AF_INET6: expectlen=sizeof(ent->bound.v6); break;
- default: abort();
+ case AF_INET: sin =addrv; el=sizeof(*sin ); iav=&sin ->sin_addr ; port=sin ->sin_port ; break;
+ case AF_INET6: sin6=addrv; el=sizeof(*sin6); iav=&sin6->sin6_addr; port=sin6->sin6_port; break;
+ default: errno=ESRCH; return -1;
}
- if (addrlen!=expectlen) { errno=EINVAL; return -1; }
+//fprintf(stderr,"af=%lu el=%lu addrlen=%lu\n",
+// (unsigned long)addr->sa_family,
+// (unsigned long)el,
+// (unsigned long)addrlen);
+ if (addrlen!=el) { errno=EINVAL; return -1; }
+ char *p=buf;
+ if (!inet_ntop(addr->sa_family,iav,p,INET6_ADDRSTRLEN)) return -1;
+ p+=strlen(p);
+ sprintf(p,",%u",(unsigned)ntohs(port));
+ return 0;
+}
+
+static int str2addrport(char *str,
+ struct sockaddr *addr, socklen_t *addrlen) {
+ union {
+ struct sockaddr_in sin;
+ struct sockaddr_in6 sin6;
+ } si;
+
+ memset(&si,0,sizeof(si));
+
+ int af;
+ void *iav;
+ uint16_t *portp;
+ socklen_t al;
+ switch (str[strcspn(str,".:")]) {
+ case '.': af=AF_INET ; iav=&si.sin .sin_addr ; al=sizeof(si.sin ); portp=&si.sin .sin_port ; break;
+ case ':': af=AF_INET6; iav=&si.sin6.sin6_addr; al=sizeof(si.sin6); portp=&si.sin6.sin6_port; break;
+ default: errno=ESRCH; return -1;
+ }
+ si.sin.sin_family=af;
+
+ char *comma=strchr(str,',');
+ if (!comma) { errno=ESRCH; return -1; }
+ *comma++=0;
+ if (inet_pton(af,str,iav)) return -1;
+
+ char *ep;
+ errno=0;
+ unsigned long port=strtoul(comma,&ep,10);
+ if (ep==comma || *ep || errno || port>65536) { errno=ESRCH; return -1; }
+ *portp= htons(port);
+
+ if (addr) memcpy(addr,&si, *addrlen<al ? *addrlen : al);
+ *addrlen=al;
return 0;
}
table[fd]=malloc(sizeof(*table[fd]));
if (!table[fd]) goto fail;
table[fd]->af=domain;
- table[fd]->bound.v4.sin_family=0;
return fd;
fail:
WRAP(bind) {
fdinfo *ent=lookup(fd);
- if (!ent) return bind(fd,addr,addrlen);
- if (chkaddr(ent,addr,addrlen)) return -1;
- memset(&ent->bound,0,sizeof(ent->bound));
- memcpy(&ent->bound,addr,addrlen);
+ if (!ent) return old_bind(fd,addr,addrlen);
+ const char *dir = getenv("UDP_PRELOAD_DIR");
+ if (!dir) { errno=ECHILD; return -1; }
+ struct sockaddr_un sun;
+ memset(&sun,0,sizeof(sun));
+ sun.sun_family=AF_UNIX;
+ int dl = strlen(dir);
+ if (dl + 1 + ADDRPORTSTRLEN + 1 > sizeof(sun.sun_path)) {
+ errno=ENAMETOOLONG; return -1;
+ }
+ strcpy(sun.sun_path,dir);
+ char *p=sun.sun_path+dl;
+ *p++='/';
+ if (addrport2str(p,addr,addrlen)) return -1;
+//fprintf(stderr,"binding %s\n",sun.sun_path);
+ if (unlink(sun.sun_path) && errno!=ENOENT) return -1;
+ return old_bind(fd,(const void*)&sun,sizeof(sun));
+}
+
+WRAP(setsockopt) {
+ fdinfo *ent=lookup(fd);
+ if (!ent) return old_setsockopt(fd,level,optname,optval,optlen);
+ if (ent->af==AF_INET6 && level==IPPROTO_IPV6 && optname==IPV6_V6ONLY
+ && optlen==sizeof(int) && *(int*)optval==1) {
+ return 0;
+ }
+ errno=ENOTTY;
+ return -1;
+}
+
+WRAP(getsockname) {
+ fdinfo *ent=lookup(fd);
+ if (!ent) return old_getsockname(fd,addr,addrlen);
+ struct sockaddr_un sun;
+ socklen_t sunlen=sizeof(sun);
+ if (old_getsockname(fd,(void*)&sun,&sunlen)) return -1;
+ if (sun.sun_family!=AF_UNIX || sunlen>sizeof(sun)) {
+//fprintf(stderr,"old_getsockname af=%lu sunlen=%lu\n",
+// (unsigned long)sun.sun_family,
+// (unsigned long)sunlen);
+ errno=EDOM; return -1;
+ }
+ if (str2addrport(sun.sun_path,addr,addrlen)) return -1;
return 0;
}
~ian / secnet.git / blobdiff