test/udp-preload.c

   1 /*
   2  *  libauthbind.c - bind(2)-redirector library for authbind
   3  *
   4  *  authbind is Copyright (C) 1998 Ian Jackson
   5  *
   6  *  This program is free software; you can redistribute it and/or modify
   7  *  it under the terms of the GNU General Public License as published by
   8  *  the Free Software Foundation; either version 2, or (at your option)
   9  *  any later version.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software Foundation,
  18  *  Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  19  *
  20  */
  21
  22 #define _GNU_SOURCE
  23
  24 #include <dlfcn.h>
  25 #include <stdio.h>
  26 #include <sys/types.h>
  27 #include <unistd.h>
  28 #include <errno.h>
  29 #include <stdlib.h>
  30 #include <signal.h>
  31 #include <string.h>
  32 #include <sys/socket.h>
  33 #include <sys/wait.h>
  34 #include <netinet/in.h>
  35
  36 #include <sys/socket.h>
  37 #include <sys/un.h>
  38 #include <arpa/inet.h>
  39
  40 #define STDERRSTR_CONST(m) write(2,m,sizeof(m)-1)
  41 #define STDERRSTR_STRING(m) write(2,m,strlen(m))
  42
  43 typedef void anyfn_type(void);
  44
  45 static anyfn_type *find_any(const char *name) {
  46   static const char *dlerr;
  47   anyfn_type *kv;
  48
  49   kv= dlsym(RTLD_NEXT,name); if (kv) return kv;
  50   dlerr= dlerror(); if (!dlerr) dlerr= "dlsym() failed for no reason";
  51   STDERRSTR_CONST("libauthbind: error finding original version of ");
  52   STDERRSTR_STRING(name);
  53   STDERRSTR_CONST(": ");
  54   STDERRSTR_STRING(dlerr);
  55   STDERRSTR_STRING("\n");
  56   errno= ENOSYS;
  57   return 0;
  58 }
  59
  60 #define socket_args int domain, int type, int protocol
  61 #define close_args  int fd
  62 #define bind_args   int fd, const struct sockaddr *addr, socklen_t addrlen
  63 #define sendto_args int fd, const void *buf, size_t len, int flags, \
  64                     const struct sockaddr *addr, socklen_t addrlen
  65 #define setsockopt_args  int fd, int level, int optname, \
  66                          const void *optval, socklen_t optlen
  67 #define getsockname_args int fd, struct sockaddr *addr, socklen_t *addrlen
  68 #define WRAPS(X)                                        \
  69     X(socket,     int,     (domain,type,protocol))              \
  70     X(close,      int,     (fd))                                        \
  71     X(bind,       int,     (fd,addr,addrlen))                   \
  72     X(sendto,     ssize_t, (fd,buf,len,flags,addr,addrlen))     \
  73     X(setsockopt, int,     (fd,level,optname,optval,optlen))    \
  74     X(getsockname,int,     (fd,addr,addrlen))
  75
  76 #define DEF_OLD(fn,rt,args)                             \
  77   typedef rt fn##_fn_type(fn##_args);                   \
  78   static rt find_##fn(fn##_args);                       \
  79   static fn##_fn_type find_##fn, *old_##fn=find_##fn;   \
  80   static rt find_##fn(fn##_args) {                      \
  81     anyfn_type *anyfn;                                  \
  82     anyfn= find_any(#fn); if (!anyfn) return -1;        \
  83     old_##fn= (fn##_fn_type*)anyfn;                     \
  84     return old_##fn args;                               \
  85   }
  86
  87 WRAPS(DEF_OLD)
  88
  89 #define WRAP(fn) int fn(fn##_args)
  90 #define TWRAP(fn) fn(fn##_args)
  91
  92 typedef struct{
  93     int af;
  94 } fdinfo;
  95 static fdinfo **table;
  96 static int tablesz;
  97
  98 static fdinfo *lookup(int fd) {
  99     if (fd>=tablesz) return 0;
 100     return table[fd];
 101 }
 102
 103 #define ADDRPORTSTRLEN (INET6_ADDRSTRLEN+1+5) /* not including nul */
 104
 105 static int addrport2str(char buf[ADDRPORTSTRLEN+1],
 106                         const struct sockaddr *addr, socklen_t addrlen) {
 107     const void *addrv=addr;
 108     const void *iav;
 109     const struct sockaddr_in  *sin;
 110     const struct sockaddr_in6 *sin6;
 111     uint16_t port;
 112     socklen_t el;
 113     switch (addr->sa_family) {
 114     case AF_INET:  sin =addrv; el=sizeof(*sin ); iav=&sin ->sin_addr ; port=sin ->sin_port ; break;
 115     case AF_INET6: sin6=addrv; el=sizeof(*sin6); iav=&sin6->sin6_addr; port=sin6->sin6_port; break;
 116     default: errno=ESRCH; return -1;
 117     }
 118 //fprintf(stderr,"af=%lu el=%lu addrlen=%lu\n",
 119 //      (unsigned long)addr->sa_family,
 120 //      (unsigned long)el,
 121 //      (unsigned long)addrlen);
 122     if (addrlen!=el) { errno=EINVAL; return -1; }
 123     char *p=buf;
 124     if (!inet_ntop(addr->sa_family,iav,p,INET6_ADDRSTRLEN)) return -1;
 125     p+=strlen(p);
 126     sprintf(p,",%u",(unsigned)ntohs(port));
 127     return 0;
 128 }
 129
 130 static int str2addrport(char *str,
 131                         struct sockaddr *addr, socklen_t *addrlen) {
 132     union {
 133         struct sockaddr_in  sin;
 134         struct sockaddr_in6 sin6;
 135     } si;
 136
 137     memset(&si,0,sizeof(si));
 138
 139     int af;
 140     void *iav;
 141     uint16_t *portp;
 142     socklen_t al;
 143     switch (str[strcspn(str,".:")]) {
 144     case '.': af=AF_INET ; iav=&si.sin .sin_addr ; al=sizeof(si.sin ); portp=&si.sin .sin_port ; break;
 145     case ':': af=AF_INET6; iav=&si.sin6.sin6_addr; al=sizeof(si.sin6); portp=&si.sin6.sin6_port; break;
 146     default: errno=ESRCH; return -1;
 147     }
 148     si.sin.sin_family=af;
 149
 150     char *comma=strchr(str,',');
 151     if (!comma) { errno=ESRCH; return -1; }
 152     *comma++=0;
 153     if (inet_pton(af,str,iav)) return -1;
 154
 155     char *ep;
 156     errno=0;
 157     unsigned long port=strtoul(comma,&ep,10);
 158     if (ep==comma || *ep || errno || port>65536) { errno=ESRCH; return -1; }
 159     *portp= htons(port);
 160
 161     if (addr) memcpy(addr,&si, *addrlen<al ? *addrlen : al);
 162     *addrlen=al;
 163     return 0;
 164 }
 165
 166 static char *sun_prep(struct sockaddr_un *sun) {
 167     const char *dir=getenv("UDP_PRELOAD_DIR");
 168     if (!dir) { errno=ECHILD; return 0; }
 169
 170     memset(sun,0,sizeof(*sun));
 171     sun->sun_family=AF_UNIX;
 172     int dl = strlen(dir);
 173     if (dl + 1 + ADDRPORTSTRLEN + 1 > sizeof(sun->sun_path)) {
 174         errno=ENAMETOOLONG; return 0;
 175     }
 176     strcpy(sun->sun_path,dir);
 177     char *p=sun->sun_path+dl;
 178     *p++='/';
 179     return p;
 180 }
 181
 182 WRAP(socket) {
 183     if (!((domain==AF_INET || domain==AF_INET6) &&
 184           type==SOCK_DGRAM))
 185         return old_socket(domain,type,protocol);
 186     int fd=socket(AF_UNIX,SOCK_DGRAM,0);
 187     if (fd<0) return fd;
 188     if (fd>=tablesz) {
 189         int newsz=(fd+1)*2;
 190         table=realloc(table,newsz*sizeof(*table));
 191         if (!table) goto fail;
 192         while (tablesz<newsz) table[tablesz++]=0;
 193     }
 194     free(table[fd]);
 195     table[fd]=malloc(sizeof(*table[fd]));
 196     if (!table[fd]) goto fail;
 197     table[fd]->af=domain;
 198     return fd;
 199
 200  fail:
 201     close(fd);
 202     return -1;
 203 }
 204
 205 WRAP(close) {
 206     if (fd<tablesz) {
 207         free(table[fd]);
 208         table[fd]=0;
 209     }
 210     return old_close(fd);
 211 }
 212
 213 WRAP(bind) {
 214     fdinfo *ent=lookup(fd);
 215     if (!ent) return old_bind(fd,addr,addrlen);
 216     struct sockaddr_un sun;
 217     char *p=sun_prep(&sun);
 218     if (addrport2str(p,addr,addrlen)) return -1;
 219 //fprintf(stderr,"binding %s\n",sun.sun_path);
 220     if (unlink(sun.sun_path) && errno!=ENOENT) return -1;
 221     return old_bind(fd,(const void*)&sun,sizeof(sun));
 222 }
 223
 224 WRAP(setsockopt) {
 225     fdinfo *ent=lookup(fd);
 226     if (!ent) return old_setsockopt(fd,level,optname,optval,optlen);
 227     if (ent->af==AF_INET6 && level==IPPROTO_IPV6 && optname==IPV6_V6ONLY
 228         && optlen==sizeof(int) && *(int*)optval==1) {
 229         return 0;
 230     }
 231     errno=ENOTTY;
 232     return -1;
 233 }
 234
 235 WRAP(getsockname) {
 236     fdinfo *ent=lookup(fd);
 237     if (!ent) return old_getsockname(fd,addr,addrlen);
 238     struct sockaddr_un sun;
 239     socklen_t sunlen=sizeof(sun);
 240     if (old_getsockname(fd,(void*)&sun,&sunlen)) return -1;
 241     if (sun.sun_family!=AF_UNIX || sunlen>sizeof(sun)) {
 242 //fprintf(stderr,"old_getsockname af=%lu sunlen=%lu\n",
 243 //      (unsigned long)sun.sun_family,
 244 //      (unsigned long)sunlen);
 245         errno=EDOM; return -1;
 246     }
 247     if (str2addrport(sun.sun_path,addr,addrlen)) return -1;
 248     return 0;
 249 }
 250
 251 ssize_t TWRAP(sendto) {
 252     fdinfo *ent=lookup(fd);
 253     if (!ent) return old_sendto(fd,buf,len,flags,addr,addrlen);
 254
 255     if (flags) { errno=ENOEXEC; return -1; }
 256
 257     const char *leaf=getenv("UDP_PRELOAD_SERVER");
 258     if (!leaf) leaf="udp";
 259     if (strlen(leaf) > ADDRPORTSTRLEN) { errno=ENAMETOOLONG; return -1; }
 260     struct sockaddr_un sun;
 261     char *p=sun_prep(&sun);
 262     strcpy(p,leaf);
 263
 264     char tbuf[ADDRPORTSTRLEN+1];
 265     memset(tbuf,0,sizeof(tbuf));
 266     if (addrport2str(tbuf,addr,addrlen)) return -1;
 267
 268     struct iovec iov[2];
 269     iov[0].iov_base=tbuf;
 270     iov[0].iov_len=sizeof(tbuf);
 271     iov[1].iov_base=(void*)buf;
 272     iov[1].iov_len=len;
 273
 274     struct msghdr m;
 275     memset(&m,0,sizeof(m));
 276     m.msg_name=&sun;
 277     m.msg_namelen=sizeof(sun);
 278     m.msg_iov=iov;
 279     m.msg_iovlen=2;
 280
 281     return sendmsg(fd,&m,0);
 282 }