pkstream/pkstream.c: Fetch protocol family codes from addresses.
[tripe] / pkstream / pkstream.c
index f1ddf77..c0deff7 100644 (file)
 
 /*----- Data structures ---------------------------------------------------*/
 
+typedef union addr {
+  struct sockaddr sa;
+  struct sockaddr_in sin;
+} addr;
+
 typedef struct pk {
   struct pk *next;                     /* Next packet in the chain */
   octet *p, *o;                                /* Buffer start and current posn */
@@ -73,8 +78,10 @@ typedef struct pkstream {
 } pkstream;
 
 typedef struct connwait {
+  unsigned f;                          /* Various flags */
+#define cwf_port 1u                    /*   Port is defined => listen */
   sel_file a;                          /* Selector */
-  struct sockaddr_in me, peer;        /* Who I'm meant to be; who peer is */
+  addr me, peer;                      /* Who I'm meant to be; who peer is */
 } connwait;
 
 /*----- Static variables --------------------------------------------------*/
@@ -92,11 +99,40 @@ static int nonblockify(int fd)
 static int cloexec(int fd)
   { return (fdflags(fd, 0, 0, FD_CLOEXEC, FD_CLOEXEC)); }
 
-static void initaddr(struct sockaddr_in *sin)
+static socklen_t addrsz(const addr *a)
 {
-  sin->sin_family = AF_INET;
-  sin->sin_addr.s_addr = INADDR_ANY;
-  sin->sin_port = 0;
+  switch (a->sa.sa_family) {
+    case AF_INET: return sizeof(a->sin);
+    default: abort();
+  }
+}
+
+static const char *addrstr(const addr *a)
+{
+  static char buf[128];
+  socklen_t n = sizeof(buf);
+
+  if (getnameinfo(&a->sa, addrsz(a), buf, n, 0, 0, NI_NUMERICHOST))
+    return ("<addrstr failed>");
+  return (buf);
+}
+
+static int addreq(const addr *a, const addr *b)
+{
+  if (a->sa.sa_family != b->sa.sa_family) return (0);
+  switch (a->sa.sa_family) {
+    case AF_INET:
+      return (a->sin.sin_addr.s_addr == b->sin.sin_addr.s_addr);
+    default:
+      abort();
+  }
+}
+
+static void initaddr(addr *a)
+{
+  a->sin.sin_family = AF_INET;
+  a->sin.sin_addr.s_addr = INADDR_ANY;
+  a->sin.sin_port = 0;
 }
 
 static void dolisten(void);
@@ -115,7 +151,7 @@ static void doclose(pkstream *p)
     xfree(pk);
   }
   xfree(p);
-  if (cw.me.sin_port) dolisten();
+  if (cw.f&cwf_port) dolisten();
   else exit(0);
 }
 
@@ -223,17 +259,16 @@ static void dofwd(int fd_in, int fd_out)
 static void doaccept(int fd_s, unsigned mode, void *p)
 {
   int fd;
-  struct sockaddr_in sin;
-  socklen_t sz = sizeof(sin);
+  addr a;
+  socklen_t sz = sizeof(a);
 
-  if ((fd = accept(fd_s, (struct sockaddr *)&sin, &sz)) < 0) {
+  if ((fd = accept(fd_s, &a.sa, &sz)) < 0) {
     if (errno == EAGAIN || errno == EWOULDBLOCK || errno == EINTR) return;
     moan("couldn't accept incoming connection: %s", strerror(errno));
     return;
   }
-  if (cw.peer.sin_addr.s_addr != INADDR_ANY &&
-      cw.peer.sin_addr.s_addr != sin.sin_addr.s_addr) {
-    moan("rejecting connection from %s", inet_ntoa(sin.sin_addr));
+  if (cw.peer.sin.sin_addr.s_addr != INADDR_ANY && !addreq(&a, &cw.peer)) {
+    moan("rejecting connection from %s", addrstr(&a));
     close(fd); return;
   }
   if (nonblockify(fd) || cloexec(fd)) {
@@ -250,9 +285,9 @@ static void dolisten(void)
   int fd;
   int opt = 1;
 
-  if ((fd = socket(PF_INET, SOCK_STREAM, 0)) < 0 ||
+  if ((fd = socket(cw.me.sa.sa_family, SOCK_STREAM, 0)) < 0 ||
       setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &opt, sizeof(opt)) ||
-      bind(fd, (struct sockaddr *)&cw.me, sizeof(cw.me)) ||
+      bind(fd, &cw.me.sa, addrsz(&cw.me)) ||
       listen(fd, 1) || nonblockify(fd) || cloexec(fd))
     die(1, "couldn't set up listening socket: %s", strerror(errno));
   sel_initfile(&sel, &cw.a, fd, SEL_READ, doaccept, 0);
@@ -260,8 +295,7 @@ static void dolisten(void)
 }
 
 #define paf_parse 1u
-static void parseaddr(const char *host, const char *svc, unsigned f,
-                     struct sockaddr_in *sin)
+static void parseaddr(const char *host, const char *svc, unsigned f, addr *a)
 {
   char *alloc = 0, *sep;
   struct hostent *h;
@@ -278,14 +312,14 @@ static void parseaddr(const char *host, const char *svc, unsigned f,
 
   if (host) {
     if ((h = gethostbyname(host)) == 0) die(1, "unknown host `%s'", host);
-    memcpy(&sin->sin_addr, h->h_addr, sizeof(sin->sin_addr));
+    memcpy(&a->sin.sin_addr, h->h_addr, sizeof(a->sin.sin_addr));
   }
 
   if (svc) {
     if ((n = strtoul(svc, &qq, 0)) > 0 && !*qq && n <= 0xffff)
-      sin->sin_port = htons(n);
+      a->sin.sin_port = htons(n);
     else if ((s = getservbyname(svc, "tcp")) != 0)
-      sin->sin_port = s->s_port;
+      a->sin.sin_port = s->s_port;
     else
       die(1, "bad service name/number `%s'", svc);
   }
@@ -329,14 +363,16 @@ int main(int argc, char *argv[])
 {
   unsigned f = 0;
   const char *bindhost = 0, *bindsvc = 0, *peerhost = 0;
-  struct sockaddr_in bindaddr;
+  addr bindaddr;
   const char *connhost = 0;
-  struct sockaddr_in tmpaddr;
+  addr tmpaddr;
   int fd = -1;
   int len = 65536;
 
 #define f_bogus 1u
 
+  cw.f = 0;
+
   ego(argv[0]);
   sel_init(&sel);
   for (;;) {
@@ -375,11 +411,14 @@ int main(int argc, char *argv[])
   if (bindsvc && connhost)
     die(1, "can't listen and connect");
 
-  initaddr(&cw.me);
   if (bindhost || bindsvc) {
     initaddr(&bindaddr);
     if (!bindsvc) parseaddr(bindhost, 0, 0, &bindaddr);
-    else parseaddr(bindhost, bindsvc, 0, &cw.me);
+    else {
+      initaddr(&cw.me);
+      parseaddr(bindhost, bindsvc, 0, &cw.me);
+      cw.f |= cwf_port;
+    }
   }
 
   initaddr(&cw.peer);
@@ -388,10 +427,10 @@ int main(int argc, char *argv[])
   if (connhost) {
     initaddr(&tmpaddr);
     parseaddr(connhost, 0, paf_parse, &tmpaddr);
-    if ((fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP)) < 0 ||
+    if ((fd = socket(tmpaddr.sa.sa_family, SOCK_STREAM, IPPROTO_TCP)) < 0 ||
        (bindhost &&
-        bind(fd, (struct sockaddr *)&bindaddr, sizeof(bindaddr))) ||
-       connect(fd, (struct sockaddr *)&tmpaddr, sizeof(tmpaddr)))
+        bind(fd, &bindaddr.sa, addrsz(&bindaddr))) ||
+       connect(fd, &tmpaddr.sa, addrsz(&tmpaddr)))
       die(1, "couldn't connect to TCP server: %s", strerror(errno));
     if (nonblockify(fd) || cloexec(fd))
       die(1, "couldn't connect to TCP server: %s", strerror(errno));
@@ -399,15 +438,15 @@ int main(int argc, char *argv[])
 
   initaddr(&tmpaddr);
   parseaddr(argv[optind], 0, paf_parse, &tmpaddr);
-  if ((fd_udp = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP)) < 0 ||
+  if ((fd_udp = socket(tmpaddr.sa.sa_family, SOCK_DGRAM, IPPROTO_UDP)) < 0 ||
       nonblockify(fd_udp) || cloexec(fd_udp) ||
       setsockopt(fd_udp, SOL_SOCKET, SO_RCVBUF, &len, sizeof(len)) ||
       setsockopt(fd_udp, SOL_SOCKET, SO_SNDBUF, &len, sizeof(len)) ||
-      bind(fd_udp, (struct sockaddr *)&tmpaddr, sizeof(tmpaddr)))
+      bind(fd_udp, &tmpaddr.sa, addrsz(&tmpaddr)))
     die(1, "couldn't set up UDP socket: %s", strerror(errno));
   initaddr(&tmpaddr);
   parseaddr(argv[optind + 1], 0, paf_parse, &tmpaddr);
-  if (connect(fd_udp, (struct sockaddr *)&tmpaddr, sizeof(tmpaddr)))
+  if (connect(fd_udp, &tmpaddr.sa, addrsz(&tmpaddr)))
     die(1, "couldn't set up UDP socket: %s", strerror(errno));
 
   if (bindsvc) dolisten();