lib/ip/bind.c

   1 #include <errno.h>
   2 #include <stdio.h>
   3 #include <string.h>
   4 #include <sys/ioctl.h>
   5 #include <sys/socket.h>
   6 #include <netinet/in.h>
   7
   8 #include <net/gen/in.h>
   9 #include <net/gen/tcp.h>
  10 #include <net/gen/tcp_io.h>
  11 #include <net/gen/udp.h>
  12 #include <net/gen/udp_io.h>
  13
  14 #define DEBUG 0
  15
  16 static int _tcp_bind(int socket, const struct sockaddr *address,
  17         socklen_t address_len, nwio_tcpconf_t *tcpconfp);
  18 static int _udp_bind(int socket, const struct sockaddr *address,
  19         socklen_t address_len, nwio_udpopt_t *udpoptp);
  20
  21 int bind(int socket, const struct sockaddr *address, socklen_t address_len)
  22 {
  23         int r;
  24         nwio_tcpconf_t tcpconf;
  25         nwio_udpopt_t udpopt;
  26
  27         r= ioctl(socket, NWIOGTCPCONF, &tcpconf);
  28         if (r != -1 || (errno != ENOTTY && errno != EBADIOCTL))
  29         {
  30                 if (r == -1)
  31                         return r;
  32                 r= _tcp_bind(socket, address, address_len, &tcpconf);
  33 #if DEBUG
  34                 if (r == -1)
  35                 {
  36                         int t_errno= errno;
  37                         fprintf(stderr, "bind(tcp) failed: %s\n",
  38                                 strerror(errno));
  39                         errno= t_errno;
  40                 }
  41 #endif
  42                 return r;
  43         }
  44
  45         r= ioctl(socket, NWIOGUDPOPT, &udpopt);
  46         if (r != -1 || (errno != ENOTTY && errno != EBADIOCTL))
  47         {
  48                 if (r == -1)
  49                         return r;
  50                 return _udp_bind(socket, address, address_len, &udpopt);
  51         }
  52
  53 #if DEBUG
  54         fprintf(stderr, "bind: not implemented for fd %d\n", socket);
  55 #endif
  56         errno= ENOSYS;
  57         return -1;
  58 }
  59
  60 static int _tcp_bind(int socket, const struct sockaddr *address,
  61         socklen_t address_len, nwio_tcpconf_t *tcpconfp)
  62 {
  63         int r;
  64         nwio_tcpconf_t tcpconf;
  65         struct sockaddr_in *sinp;
  66
  67         sinp= (struct sockaddr_in *)address;
  68         if (sinp->sin_family != AF_INET || address_len != sizeof(*sinp))
  69         {
  70 #if DEBUG
  71                 fprintf(stderr, "bind(tcp): sin_family = %d, len = %d\n",
  72                         sinp->sin_family, address_len);
  73 #endif
  74                 errno= EAFNOSUPPORT;
  75                 return -1;
  76         }
  77
  78         if (sinp->sin_addr.s_addr != INADDR_ANY &&
  79                 sinp->sin_addr.s_addr != tcpconfp->nwtc_locaddr)
  80         {
  81                 errno= EADDRNOTAVAIL;
  82                 return -1;
  83         }
  84
  85         tcpconf.nwtc_flags= 0;
  86
  87         if (sinp->sin_port == 0)
  88                 tcpconf.nwtc_flags |= NWTC_LP_SEL;
  89         else
  90         {
  91                 tcpconf.nwtc_flags |= NWTC_LP_SET;
  92                 tcpconf.nwtc_locport= sinp->sin_port;
  93         }
  94
  95         r= ioctl(socket, NWIOSTCPCONF, &tcpconf);
  96         return r;
  97 }
  98
  99 static int _udp_bind(int socket, const struct sockaddr *address,
 100         socklen_t address_len, nwio_udpopt_t *udpoptp)
 101 {
 102         int r;
 103         unsigned long curr_flags;
 104         nwio_udpopt_t udpopt;
 105         struct sockaddr_in *sinp;
 106
 107         sinp= (struct sockaddr_in *)address;
 108         if (sinp->sin_family != AF_INET || address_len != sizeof(*sinp))
 109         {
 110 #if DEBUG
 111                 fprintf(stderr, "bind(udp): sin_family = %d, len = %d\n",
 112                         sinp->sin_family, address_len);
 113 #endif
 114                 errno= EAFNOSUPPORT;
 115                 return -1;
 116         }
 117
 118         if (sinp->sin_addr.s_addr != INADDR_ANY &&
 119                 sinp->sin_addr.s_addr != udpoptp->nwuo_locaddr)
 120         {
 121                 errno= EADDRNOTAVAIL;
 122                 return -1;
 123         }
 124
 125         udpopt.nwuo_flags= 0;
 126
 127         if (sinp->sin_port == 0)
 128                 udpopt.nwuo_flags |= NWUO_LP_SEL;
 129         else
 130         {
 131                 udpopt.nwuo_flags |= NWUO_LP_SET;
 132                 udpopt.nwuo_locport= sinp->sin_port;
 133         }
 134
 135         curr_flags= udpoptp->nwuo_flags;
 136         if (!(curr_flags & NWUO_ACC_MASK))
 137                 udpopt.nwuo_flags |= NWUO_EXCL;
 138         if (!(curr_flags & (NWUO_EN_LOC|NWUO_DI_LOC)))
 139                 udpopt.nwuo_flags |= NWUO_EN_LOC;
 140         if (!(curr_flags & (NWUO_EN_BROAD|NWUO_DI_BROAD)))
 141                 udpopt.nwuo_flags |= NWUO_EN_BROAD;
 142         if (!(curr_flags & (NWUO_RP_SET|NWUO_RP_ANY)))
 143                 udpopt.nwuo_flags |= NWUO_RP_ANY;
 144         if (!(curr_flags & (NWUO_RA_SET|NWUO_RA_ANY)))
 145                 udpopt.nwuo_flags |= NWUO_RA_ANY;
 146         if (!(curr_flags & (NWUO_RWDATONLY|NWUO_RWDATALL)))
 147                 udpopt.nwuo_flags |= NWUO_RWDATALL;
 148         if (!(curr_flags & (NWUO_EN_IPOPT|NWUO_DI_IPOPT)))
 149                 udpopt.nwuo_flags |= NWUO_DI_IPOPT;
 150
 151         r= ioctl(socket, NWIOSUDPOPT, &udpopt);
 152         return r;
 153 }