2 * Dolda Connect - Modular multiuser Direct Connect-style client
3 * Copyright (C) 2004 Fredrik Tolf <fredrik@dolda2000.com>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 /* XXX: Implement SOCKS proxyability */
28 #include <sys/ioctl.h>
29 #include <sys/socket.h>
31 #include <sys/select.h>
32 #include <arpa/inet.h>
33 #include <netinet/in.h>
35 #include <sys/signal.h>
36 #include <sys/stat.h> /* For rebindunix() */
37 #ifdef HAVE_LINUX_SOCKIOS_H
38 #include <linux/sockios.h>
48 #include "sysevents.h"
50 static struct configvar myvars[] =
52 /** The network mode to use. Currently supported values are 0 for
53 * active mode and 1 for passive mode. In the future, SOCKS5 proxy
54 * support may be added. */
55 {CONF_VAR_INT, "mode", {.num = 0}},
56 /** Set the SO_REUSEADDR socket option on listening sockets, so
57 * that dead TCP connections waiting for timeout are ignored. */
58 {CONF_VAR_BOOL, "reuseaddr", {.num = 0}},
59 /** Overrides the IPv4 address reported to other clients in active
60 * mode. Useful for servers behind NAT routers. If both this and
61 * net.publicif are unspecified the address of the hub connection
63 {CONF_VAR_IPV4, "visibleipv4", {.ipv4 = {0}}},
64 /** Specifies an interface name from which to fetch the IPv4
65 * address reported to other clients in active mode. If both this
66 * and net.visibleipv4 are unspecified the address of the hub
67 * connection is used. */
68 {CONF_VAR_STRING, "publicif", {.str = L""}},
69 /** The Diffserv value to use on IPv6 connections when the
70 * minimize cost TOS value is used (see the TOS VALUES
72 {CONF_VAR_INT, "diffserv-mincost", {.num = 0}},
73 /** The Diffserv value to use on IPv6 connections when the
74 * maximize reliability TOS value is used (see the TOS VALUES
76 {CONF_VAR_INT, "diffserv-maxrel", {.num = 0}},
77 /** The Diffserv value to use on IPv6 connections when the
78 * maximize throughput TOS value is used (see the TOS VALUES
80 {CONF_VAR_INT, "diffserv-maxtp", {.num = 0}},
81 /** The Diffserv value to use on IPv6 connections when the
82 * minimize delay TOS value is used (see the TOS VALUES
84 {CONF_VAR_INT, "diffserv-mindelay", {.num = 0}},
85 /** If enabled, the IP TOS interface will be used to set Diffserv
86 * codepoints on IPv4 sockets, by shifting the DSCP value two bits
87 * to the left (remember, the DSCP field in the IPv4 header is
88 * defined as the 6 uppermost bits of the TOS field, the lower two
89 * being left for ECN). This may only work on Linux. */
90 {CONF_VAR_BOOL, "dscp-tos", {.num = 0}},
104 struct ufd *next, *prev;
113 struct sockaddr *remote;
127 static int getlocalname(int fd, struct sockaddr **namebuf, socklen_t *lenbuf);
129 static struct ufd *ufds = NULL;
130 static struct scons *rbatch, *wbatch, *cbatch;
133 /* XXX: Get autoconf for all this... */
134 int getpublicaddr(int af, struct sockaddr **addr, socklen_t *lenbuf)
136 struct sockaddr_in *ipv4;
137 struct configvar *var;
141 struct ifreq *ifr, req;
146 var = confgetvar("net", "visibleipv4");
147 if(var->val.ipv4.s_addr != 0)
149 ipv4 = smalloc(sizeof(*ipv4));
150 ipv4->sin_family = AF_INET;
151 ipv4->sin_addr.s_addr = var->val.ipv4.s_addr;
152 *addr = (struct sockaddr *)ipv4;
153 *lenbuf = sizeof(*ipv4);
156 if((pif = icswcstombs(confgetstr("net", "publicif"), NULL, NULL)) == NULL)
158 flog(LOG_ERR, "could not convert net.publicif into local charset: %s", strerror(errno));
163 if((sock = socket(AF_INET, SOCK_DGRAM, 0)) < 0)
165 conf.ifc_buf = smalloc(conf.ifc_len = 65536);
166 if(ioctl(sock, SIOCGIFCONF, &conf) < 0)
172 bufend = ((char *)conf.ifc_buf) + conf.ifc_len;
174 for(ifr = conf.ifc_ifcu.ifcu_req; (void *)ifr < bufend; ifr++)
176 if(strcmp(ifr->ifr_name, pif))
178 memset(&req, 0, sizeof(req));
179 memcpy(req.ifr_name, ifr->ifr_name, sizeof(ifr->ifr_name));
180 if(ioctl(sock, SIOCGIFFLAGS, &req) < 0)
182 if(!(req.ifr_flags & IFF_UP))
184 flog(LOG_WARNING, "public interface is down");
187 if(ifr->ifr_addr.sa_family != AF_INET)
189 flog(LOG_WARNING, "address of the public interface is not AF_INET");
192 ipv4 = smalloc(sizeof(*ipv4));
193 memcpy(ipv4, &ifr->ifr_addr, sizeof(ifr->ifr_addr));
200 *addr = (struct sockaddr *)ipv4;
201 *lenbuf = sizeof(*ipv4);
210 static struct socket *newsock1(int dgram)
214 new = memset(smalloc(sizeof(*new)), 0, sizeof(*new));
223 static struct socket *sockpair(int dgram)
225 struct socket *s1, *s2;
227 s1 = newsock1(dgram);
228 s2 = newsock1(dgram);
235 static void sksetstate(struct socket *sk, int state)
238 sk->back->state = state;
241 struct socket *netsockpipe(void)
246 sksetstate(sk, SOCK_EST);
250 static void closeufd(struct ufd *ufd)
257 static void freeufd(struct ufd *ufd)
259 if(ufd->next != NULL)
260 ufd->next->prev = ufd->prev;
261 if(ufd->prev != NULL)
262 ufd->prev->next = ufd->next;
268 if(ufd->type == UFD_SOCK) {
269 if(ufd->d.s.remote != NULL)
270 free(ufd->d.s.remote);
275 static struct ufd *mkufd(int fd, int type, struct socket *sk)
279 ufd = memset(smalloc(sizeof(*ufd)), 0, sizeof(*ufd));
283 getsock(ufd->sk = sk);
286 if(type == UFD_SOCK) {
287 ufd->d.s.ucred.uid = -1;
288 ufd->d.s.ucred.gid = -1;
297 static struct ufd *dupufd(struct ufd *ufd)
303 nsk = sockpair(ufd->sk->dgram);
306 nufd = mkufd(ufd->fd, ufd->type, nsk);
309 if((nufd->fd = dup(ufd->fd)) < 0)
311 flog(LOG_WARNING, "could not dup() fd: %s", strerror(errno));
315 sksetstate(nsk, SOCK_EST);
316 if(ufd->type == UFD_SOCK) {
317 nufd->d.s.family = ufd->d.s.family;
318 nufd->d.s.type = ufd->d.s.type;
319 nufd->d.s.ucred.uid = ufd->d.s.ucred.uid;
320 nufd->d.s.ucred.gid = ufd->d.s.ucred.gid;
321 if(ufd->d.s.remote != NULL)
322 nufd->d.s.remote = memcpy(smalloc(ufd->d.s.remotelen), ufd->d.s.remote, nufd->d.s.remotelen = ufd->d.s.remotelen);
323 } else if(ufd->type == UFD_LISTEN) {
324 nufd->d.l.family = ufd->d.l.family;
329 static struct socket *mksock(int domain, int type)
335 if((fd = socket(domain, type, 0)) < 0)
337 flog(LOG_CRIT, "could not create socket: %s", strerror(errno));
340 sk = sockpair(type == SOCK_DGRAM);
341 ufd = mkufd(fd, UFD_SOCK, sk);
342 ufd->d.s.family = domain;
343 ufd->d.s.type = type;
344 fcntl(fd, F_SETFL, fcntl(fd, F_GETFL) | O_NONBLOCK);
348 struct socket *wrapsock(int fd)
354 ufd = mkufd(fd, UFD_PIPE, sk->back);
355 sksetstate(sk, SOCK_EST);
356 fcntl(fd, F_SETFL, fcntl(fd, F_GETFL) | O_NONBLOCK);
360 void getsock(struct socket *sk)
365 static void sockdebug(int level, struct socket *sk, char *format, ...)
370 if((sk->dbgnm == NULL) || (level > sk->dbglvl))
372 va_start(args, format);
373 tb = vsprintf2(format, args);
375 fprintf(stderr, "%s: %s\n", sk->dbgnm, tb);
379 void socksetdebug(struct socket *sk, int level, char *nm, ...)
385 tb = vsprintf2(nm, args);
387 sk->dbgnm = sprintf2("%s (f)", tb);
388 sk->back->dbgnm = sprintf2("%s (b)", tb);
391 sk->back->dbglvl = level;
392 sockdebug(1, sk, "enabled debugging");
395 static void freesock(struct socket *sk)
397 struct dgrambuf *buf;
399 sockdebug(1, sk, "freeing socket");
401 while((buf = sk->buf.d.f) != NULL) {
402 sk->buf.d.f = buf->next;
406 if(sk->buf.s.buf != NULL)
409 if(sk->dbgnm != NULL)
415 void putsock(struct socket *sk)
419 if(--(sk->refcount) < 0) {
420 flog(LOG_CRIT, "BUG: socket refcount < 0");
423 if((sk->refcount == 0) && (sk->back->refcount == 0)) {
430 void quitsock(struct socket *sk)
438 static void linksock(struct scons **list, struct socket *sk)
442 for(sc = *list; sc != NULL; sc = sc->n) {
446 sc = smalloc(sizeof(*sc));
455 void sockpushdata(struct socket *sk, void *buf, size_t size)
462 sizebuf(&sk->buf.s.buf, &sk->buf.s.bufsize, sk->buf.s.datasize + size, 1, 1);
463 memmove(sk->buf.s.buf + size, sk->buf.s.buf, sk->buf.s.datasize);
464 memcpy(sk->buf.s.buf, buf, size);
465 sk->buf.s.datasize += size;
466 linksock(&rbatch, sk);
470 /* Read as the preterite of `read' */
471 void sockread(struct socket *sk)
473 if((sockgetdatalen(sk) == 0) && (sk->eos == 1))
474 linksock(&rbatch, sk);
475 linksock(&wbatch, sk->back);
478 void freedgbuf(struct dgrambuf *dg)
487 struct dgrambuf *sockgetdgbuf(struct socket *sk)
489 struct dgrambuf *dbuf;
491 if((dbuf = sk->buf.d.f) == NULL)
493 sk->buf.d.f = dbuf->next;
494 if(dbuf->next == NULL)
501 void *sockgetinbuf(struct socket *sk, size_t *size)
504 struct dgrambuf *dbuf;
507 dbuf = sockgetdgbuf(sk);
513 if((sk->buf.s.buf == NULL) || (sk->buf.s.datasize == 0))
516 sockdebug(2, sk, "read 0 bytes", *size);
520 *size = sk->buf.s.datasize;
521 sk->buf.s.buf = NULL;
522 sk->buf.s.bufsize = sk->buf.s.datasize = 0;
525 sockdebug(2, sk, "read %zi bytes", *size);
529 void sockqueue(struct socket *sk, void *data, size_t size)
531 struct dgrambuf *new;
532 struct sockaddr *remote;
535 sockdebug(2, sk, "queued %zi bytes", size);
538 if(sk->state == SOCK_STL)
541 if(sockpeeraddr(sk, &remote, &remotelen))
543 new = smalloc(sizeof(*new));
545 memcpy(new->data = smalloc(size), data, new->size = size);
547 new->addrlen = remotelen;
548 if(sk->back->buf.d.l == NULL)
550 sk->back->buf.d.l = sk->back->buf.d.f = new;
552 sk->back->buf.d.l->next = new;
553 sk->back->buf.d.l = new;
556 sizebuf(&(sk->back->buf.s.buf), &(sk->back->buf.s.bufsize), sk->back->buf.s.datasize + size, 1, 1);
557 memcpy(sk->back->buf.s.buf + sk->back->buf.s.datasize, data, size);
558 sk->back->buf.s.datasize += size;
560 linksock(&rbatch, sk->back);
563 void sockqueuedg(struct socket *sk, struct dgrambuf *dg)
565 if(sk->state == SOCK_STL) {
570 flog(LOG_ERR, "BUG: sockqueuedg called on non-dgram socket");
575 if(sk->back->buf.d.l == NULL)
577 sk->back->buf.d.l = sk->back->buf.d.f = dg;
579 sk->back->buf.d.l->next = dg;
580 sk->back->buf.d.l = dg;
582 linksock(&rbatch, sk->back);
585 void sockerror(struct socket *sk, int en)
587 sksetstate(sk, SOCK_STL);
588 if(sk->back->errcb != NULL)
589 sk->back->errcb(sk->back, en, sk->back->data);
592 static void recvcmsg(struct ufd *ufd, struct msghdr *msg)
594 struct cmsghdr *cmsg;
596 for(cmsg = CMSG_FIRSTHDR(msg); cmsg != NULL; cmsg = CMSG_NXTHDR(msg, cmsg))
598 #if UNIX_AUTH_STYLE == 1
599 if((cmsg->cmsg_level == SOL_SOCKET) && (cmsg->cmsg_type == SCM_CREDENTIALS))
602 if(ufd->d.s.ucred.uid == -1)
604 cred = (struct ucred *)CMSG_DATA(cmsg);
605 ufd->d.s.ucred.uid = cred->uid;
606 ufd->d.s.ucred.gid = cred->gid;
613 static int ufddgram(struct ufd *ufd)
617 if(ufd->type == UFD_SOCK) {
618 dgram = ufd->d.s.type == SOCK_DGRAM;
619 } else if(ufd->type == UFD_PIPE) {
622 flog(LOG_ERR, "BUG: calling ufddgram on ufd of bad type %i", ufd->type);
625 if(ufd->sk == NULL) {
626 flog(LOG_ERR, "BUG: calling ufddgram on socketless ufd (type %i)", ufd->type);
629 if(dgram != ufd->sk->dgram) {
630 flog(LOG_ERR, "BUG: ufd/socket dgram value mismatch");
636 static void sockrecv(struct ufd *ufd)
640 struct dgrambuf *dbuf;
646 memset(&msg, 0, sizeof(msg));
647 msg.msg_iov = &bufvec;
649 msg.msg_control = cbuf;
650 msg.msg_controllen = sizeof(cbuf);
651 if((dgram = ufddgram(ufd)) < 0)
654 #if defined(HAVE_LINUX_SOCKIOS_H) && defined(SIOCINQ)
655 if(ioctl(ufd->fd, SIOCINQ, &inq))
657 /* I don't really know what could go wrong here, so let's
658 * assume it's transient. */
659 flog(LOG_WARNING, "SIOCINQ return %s on socket %i", strerror(errno), ufd->fd);
665 dbuf = smalloc(sizeof(*dbuf));
666 dbuf->data = smalloc(inq);
667 dbuf->addr = smalloc(dbuf->addrlen = sizeof(struct sockaddr_storage));
668 msg.msg_name = dbuf->addr;
669 msg.msg_namelen = dbuf->addrlen;
670 bufvec.iov_base = dbuf->data;
671 bufvec.iov_len = inq;
672 ret = recvmsg(ufd->fd, &msg, 0);
673 dbuf->addrlen = msg.msg_namelen;
677 if((errno == EINTR) || (errno == EAGAIN))
680 sockerror(ufd->sk, errno);
683 if(msg.msg_flags & MSG_CTRUNC)
684 flog(LOG_DEBUG, "ancillary data was truncated");
687 /* On UDP/IPv[46], ret == 0 doesn't mean EOF (since UDP can't
688 * have EOF), but rather an empty packet. I don't know if any
689 * other potential DGRAM protocols might have an EOF
690 * condition, so let's play safe. */
694 if((ufd->type != UFD_SOCK) || !((ufd->d.s.family == AF_INET) || (ufd->d.s.family == AF_INET6)))
701 dbuf->addr = srealloc(dbuf->addr, dbuf->addrlen);
702 dbuf->data = srealloc(dbuf->data, dbuf->size = ret);
704 sockqueuedg(ufd->sk, dbuf);
706 #if defined(HAVE_LINUX_SOCKIOS_H) && defined(SIOCINQ)
707 /* SIOCINQ is Linux-specific AFAIK, but I really have no idea
708 * how to read the inqueue size on other OSs */
709 if(ufd->type == UFD_SOCK) {
710 if(ioctl(ufd->fd, SIOCINQ, &inq))
712 /* I don't really know what could go wrong here, so let's
713 * assume it's transient. */
714 flog(LOG_WARNING, "SIOCINQ return %s on socket %i, falling back to 2048 bytes", strerror(errno), ufd->fd);
718 /* There are perils when trying to use SIOCINQ on files >2GiB... */
726 /* This part could be optimized by telling the kernel to read
727 * directly into ufd->sk->back->buf, but that would be uglier
728 * by not using the socket function interface. */
730 if(ufd->type == UFD_SOCK)
732 bufvec.iov_base = buf;
733 bufvec.iov_len = inq;
734 ret = recvmsg(ufd->fd, &msg, 0);
736 ret = read(ufd->fd, buf, inq);
737 msg.msg_controllen = 0;
743 if((errno == EINTR) || (errno == EAGAIN))
746 sockerror(ufd->sk, errno);
749 if(msg.msg_flags & MSG_CTRUNC)
750 flog(LOG_DEBUG, "ancillary data was truncated");
760 sockqueue(ufd->sk, buf, ret);
765 static int sockflush(struct ufd *ufd)
768 struct dgrambuf *dbuf;
771 if((dgram = ufddgram(ufd)) < 0) {
776 dbuf = sockgetdgbuf(ufd->sk);
777 sendto(ufd->fd, dbuf->data, dbuf->size, MSG_DONTWAIT | MSG_NOSIGNAL, dbuf->addr, dbuf->addrlen);
780 if(ufd->type == UFD_SOCK)
781 ret = send(ufd->fd, ufd->sk->buf.s.buf, ufd->sk->buf.s.datasize, MSG_DONTWAIT | MSG_NOSIGNAL);
783 ret = write(ufd->fd, ufd->sk->buf.s.buf, ufd->sk->buf.s.datasize);
787 memmove(ufd->sk->buf.s.buf, ((char *)ufd->sk->buf.s.buf) + ret, ufd->sk->buf.s.datasize -= ret);
794 void closesock(struct socket *sk)
796 sockdebug(1, sk, "closed");
797 sksetstate(sk, SOCK_STL);
798 if(sk->back->eos == 0)
800 linksock(&rbatch, sk->back);
803 size_t sockgetdatalen(struct socket *sk)
810 for(b = sk->buf.d.f; b != NULL; b = b->next)
813 ret = sk->buf.s.datasize;
818 /* size_t sockqueuesize(struct socket *sk) */
820 /* return(sockgetdatalen(sk->back)); */
823 size_t socktqueuesize(struct socket *sk)
829 ret += sockgetdatalen(sk->back);
830 if((sk = sk->back->pnext) == NULL)
835 ssize_t sockqueueleft(struct socket *sk)
837 return(sk->back->maxbuf - sockgetdatalen(sk->back));
841 * Seriously, I don't know if it's naughty or not to remove
842 * pre-existing Unix sockets.
844 static int rebindunix(struct ufd *ufd, struct sockaddr *name, socklen_t namelen)
846 struct sockaddr_un *un;
849 if((ufd->d.l.family != AF_UNIX) || (name->sa_family != PF_UNIX))
851 un = (struct sockaddr_un *)name;
852 if(stat(un->sun_path, &sb))
854 if(!S_ISSOCK(sb.st_mode))
856 if(unlink(un->sun_path))
858 if(bind(ufd->fd, name, namelen) < 0)
863 void closelport(struct lport *lp)
866 struct sockaddr_un *un;
869 if((ufd->d.l.family == AF_UNIX) && !getlocalname(ufd->fd, (struct sockaddr **)(void *)&un, NULL) && (un->sun_family == PF_UNIX) && strchr(un->sun_path, '/')) {
870 if(unlink(un->sun_path))
871 flog(LOG_WARNING, "could not unlink Unix socket %s: %s", un->sun_path, strerror(errno));
877 * The difference between netcslisten() and netcslistenlocal() is that
878 * netcslistenlocal() always listens on the local host, instead of
879 * following proxy/passive mode directions. It is suitable for eg. the
880 * UI channel, while the file sharing networks should, naturally, use
881 * netcslisten() instead.
884 struct lport *netcslistenlocal(int type, struct sockaddr *name, socklen_t namelen, void (*func)(struct lport *, struct socket *, void *), void *data)
891 /* I don't know if this is actually correct (it probably isn't),
892 * but since, at on least Linux systems, PF_* are specifically
893 * #define'd to their AF_* counterparts, it allows for a severely
894 * smoother implementation. If it breaks something on your
895 * platform, please tell me so.
897 if((fd = socket(name->sa_family, type, 0)) < 0)
899 if(confgetint("net", "reuseaddr")) {
901 setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &intbuf, sizeof(intbuf));
903 ufd = mkufd(fd, UFD_LISTEN, NULL);
904 ufd->d.l.family = name->sa_family;
905 lp = memset(smalloc(sizeof(*lp)), 0, sizeof(*lp));
908 if((bind(fd, name, namelen) < 0) && ((errno != EADDRINUSE) || (rebindunix(ufd, name, namelen) < 0))) {
912 if(listen(fd, 16) < 0)
922 struct lport *netcslisten(int type, struct sockaddr *name, socklen_t namelen, void (*func)(struct lport *, struct socket *, void *), void *data)
924 if(confgetint("net", "mode") == 1)
929 if(confgetint("net", "mode") == 0)
930 return(netcslistenlocal(type, name, namelen, func, data));
935 struct lport *netcstcplisten(int port, int local, void (*func)(struct lport *, struct socket *, void *), void *data)
937 struct sockaddr_in addr;
939 struct sockaddr_in6 addr6;
941 struct lport *(*csfunc)(int, struct sockaddr *, socklen_t, void (*)(struct lport *, struct socket *, void *), void *);
945 csfunc = netcslistenlocal;
947 csfunc = netcslisten;
949 memset(&addr6, 0, sizeof(addr6));
950 addr6.sin6_family = AF_INET6;
951 addr6.sin6_port = htons(port);
952 addr6.sin6_addr = in6addr_any;
953 if((ret = csfunc(SOCK_STREAM, (struct sockaddr *)&addr6, sizeof(addr6), func, data)) != NULL)
955 if((ret == NULL) && (errno != EAFNOSUPPORT))
958 memset(&addr, 0, sizeof(addr));
959 addr.sin_family = AF_INET;
960 addr.sin_port = htons(port);
961 return(csfunc(SOCK_STREAM, (struct sockaddr *)&addr, sizeof(addr), func, data));
964 struct socket *netcsdgram(struct sockaddr *name, socklen_t namelen)
969 mode = confgetint("net", "mode");
970 if((mode == 0) || (mode == 1))
972 if((sk = mksock(name->sa_family, SOCK_DGRAM)) == NULL)
974 if(bind(sk->ufd->fd, name, namelen) < 0)
979 sksetstate(sk, SOCK_EST);
986 struct socket *netdgramconn(struct socket *sk, struct sockaddr *addr, socklen_t addrlen)
990 nufd = dupufd(sk->back->ufd);
991 getsock(sk = nufd->sk->back);
992 memcpy(nufd->d.s.remote = smalloc(addrlen), addr, nufd->d.s.remotelen = addrlen);
997 struct socket *netcsconn(struct sockaddr *addr, socklen_t addrlen, void (*func)(struct socket *, int, void *), void *data)
1002 mode = confgetint("net", "mode");
1003 if((mode == 0) || (mode == 1))
1005 if((sk = mksock(addr->sa_family, SOCK_STREAM)) == NULL)
1007 memcpy(sk->ufd->d.s.remote = smalloc(addrlen), addr, sk->ufd->d.s.remotelen = addrlen);
1008 sk->back->conncb = func;
1009 sk->back->data = data;
1012 if(!connect(sk->ufd->fd, addr, addrlen))
1014 sksetstate(sk, SOCK_EST);
1015 linksock(&cbatch, sk->back);
1018 if(errno == EINPROGRESS)
1020 sksetstate(sk, SOCK_SYN);
1030 static void acceptunix(struct ufd *ufd)
1035 #if UNIX_AUTH_STYLE == 1
1036 if(setsockopt(ufd->fd, SOL_SOCKET, SO_PASSCRED, &buf, sizeof(buf)) < 0)
1037 flog(LOG_WARNING, "could not enable SO_PASSCRED on Unix socket %i: %s", ufd->fd, strerror(errno));
1038 #elif UNIX_AUTH_STYLE == 2
1039 if(getpeereid(ufd->fd, &ufd->d.s.ucred.uid, &ufd->d.s.ucred.gid) < 0)
1041 flog(LOG_WARNING, "could not get peer creds on Unix socket %i: %s", ufd->fd, strerror(errno));
1042 ufd->d.s.ucred.uid = -1;
1043 ufd->d.s.ucred.gid = -1;
1048 static void runbatches(void)
1050 struct scons *sc, *nsc;
1052 for(sc = cbatch, cbatch = NULL; sc; sc = nsc) {
1054 if(sc->s->conncb != NULL)
1055 sc->s->conncb(sc->s, 0, sc->s->data);
1059 for(sc = rbatch, rbatch = NULL; sc; sc = nsc) {
1061 if(sc->s->readcb != NULL)
1062 sc->s->readcb(sc->s, sc->s->data);
1063 if((sockgetdatalen(sc->s) == 0) && (sc->s->eos == 1)) {
1064 if(sc->s->errcb != NULL)
1065 sc->s->errcb(sc->s, 0, sc->s->data);
1071 for(sc = wbatch, wbatch = NULL; sc; sc = nsc) {
1073 if(sc->s->writecb != NULL)
1074 sc->s->writecb(sc->s, sc->s->data);
1080 static void cleansocks(void)
1082 struct ufd *ufd, *next;
1085 for(ufd = ufds; ufd != NULL; ufd = next) {
1088 dead = (ufd->fd < 0);
1089 if(ufd->sk->state == SOCK_STL)
1091 if((ufd->sk->state == SOCK_EST) && (sockgetdatalen(ufd->sk) == 0))
1095 if(ufd->sk->eos == 1) {
1100 if((ufd->sk->refcount == 1) && (ufd->sk->back->refcount == 0)) {
1108 int pollsocks(int timeout)
1113 fd_set rfds, wfds, efds;
1114 struct ufd *ufd, *nufd;
1116 struct sockaddr_storage ss;
1124 for(maxfd = 0, ufd = ufds; ufd != NULL; ufd = ufd->next) {
1127 if(!ufd->ignread && ((ufd->sk == NULL) || (sockqueueleft(ufd->sk) > 0)))
1128 FD_SET(ufd->fd, &rfds);
1129 if(ufd->sk != NULL) {
1130 if(sockgetdatalen(ufd->sk) > 0)
1131 FD_SET(ufd->fd, &wfds);
1132 else if(ufd->sk->state == SOCK_SYN)
1133 FD_SET(ufd->fd, &wfds);
1135 FD_SET(ufd->fd, &efds);
1139 if(rbatch || wbatch || cbatch)
1141 tv.tv_sec = timeout / 1000;
1142 tv.tv_usec = (timeout % 1000) * 1000;
1143 ret = select(maxfd + 1, &rfds, &wfds, &efds, (timeout < 0)?NULL:&tv);
1145 if(errno != EINTR) {
1146 flog(LOG_CRIT, "pollsocks: select errored out: %s", strerror(errno));
1147 /* To avoid CPU hogging in case it's bad, which it
1153 for(ufd = ufds; ufd != NULL; ufd = ufd->next) {
1156 if(ufd->type == UFD_LISTEN) {
1157 if(FD_ISSET(ufd->fd, &rfds)) {
1159 if((newfd = accept(ufd->fd, (struct sockaddr *)&ss, &sslen)) < 0) {
1160 if(ufd->d.l.lp->errcb != NULL)
1161 ufd->d.l.lp->errcb(ufd->d.l.lp, errno, ufd->d.l.lp->data);
1164 nufd = mkufd(newfd, UFD_SOCK, nsk);
1165 nufd->d.s.family = ufd->d.l.family;
1166 sksetstate(nsk, SOCK_EST);
1167 memcpy(nufd->d.s.remote = smalloc(sslen), &ss, sslen);
1168 nufd->d.s.remotelen = sslen;
1169 if(ss.ss_family == PF_UNIX)
1171 if(ufd->d.l.lp->acceptcb != NULL)
1172 ufd->d.l.lp->acceptcb(ufd->d.l.lp, nsk->back, ufd->d.l.lp->data);
1175 if(FD_ISSET(ufd->fd, &efds)) {
1176 retlen = sizeof(ret);
1177 getsockopt(ufd->fd, SOL_SOCKET, SO_ERROR, &ret, &retlen);
1178 if(ufd->d.l.lp->errcb != NULL)
1179 ufd->d.l.lp->errcb(ufd->d.l.lp, ret, ufd->d.l.lp->data);
1183 if(ufd->sk->state == SOCK_SYN) {
1184 if(FD_ISSET(ufd->fd, &efds)) {
1185 retlen = sizeof(ret);
1186 getsockopt(ufd->fd, SOL_SOCKET, SO_ERROR, &ret, &retlen);
1187 if(ufd->sk->back->conncb != NULL)
1188 ufd->sk->back->conncb(ufd->sk->back, ret, ufd->sk->back->data);
1192 if(FD_ISSET(ufd->fd, &rfds) || FD_ISSET(ufd->fd, &wfds)) {
1193 sksetstate(ufd->sk, SOCK_EST);
1194 linksock(&cbatch, ufd->sk->back);
1196 } else if(ufd->sk->state == SOCK_EST) {
1197 if(FD_ISSET(ufd->fd, &efds)) {
1198 retlen = sizeof(ret);
1199 getsockopt(ufd->fd, SOL_SOCKET, SO_ERROR, &ret, &retlen);
1200 sockerror(ufd->sk, ret);
1204 if(FD_ISSET(ufd->fd, &rfds))
1208 if(FD_ISSET(ufd->fd, &wfds)) {
1209 if(sockflush(ufd)) {
1210 sockerror(ufd->sk, errno);
1223 static struct ufd *getskufd(struct socket *sk)
1226 if(sk->back->ufd != NULL)
1227 return(sk->back->ufd);
1228 if((sk = sk->back->pnext) == NULL)
1234 int socksettos(struct socket *sk, int tos)
1241 if(ufd->type != UFD_SOCK) {
1245 if(ufd->d.s.family == AF_UNIX)
1246 return(0); /* Unix sockets are always perfect. :) */
1247 if(ufd->d.s.family == AF_INET)
1249 dscp2tos = confgetint("net", "dscp-tos");
1255 case SOCK_TOS_MINCOST:
1257 buf = confgetint("net", "diffserv-mincost") << 2;
1261 case SOCK_TOS_MAXREL:
1263 buf = confgetint("net", "diffserv-maxrel") << 2;
1267 case SOCK_TOS_MAXTP:
1269 buf = confgetint("net", "diffserv-maxtp") << 2;
1273 case SOCK_TOS_MINDELAY:
1275 buf = confgetint("net", "diffserv-mindelay") << 2;
1280 flog(LOG_WARNING, "attempted to set unknown TOS value %i to IPv4 sock", tos);
1283 if(setsockopt(ufd->fd, IPPROTO_IP, IP_TOS, &buf, sizeof(buf)) < 0)
1285 flog(LOG_WARNING, "could not set sock TOS to %i: %s", tos, strerror(errno));
1290 if(ufd->d.s.family == AF_INET6)
1296 case SOCK_TOS_MINCOST:
1297 buf = confgetint("net", "diffserv-mincost");
1299 case SOCK_TOS_MAXREL:
1300 buf = confgetint("net", "diffserv-maxrel");
1302 case SOCK_TOS_MAXTP:
1303 buf = confgetint("net", "diffserv-maxtp");
1305 case SOCK_TOS_MINDELAY:
1306 buf = confgetint("net", "diffserv-mindelay");
1309 flog(LOG_WARNING, "attempted to set unknown TOS value %i to IPv4 sock", tos);
1313 On Linux, the API IPv6 flow label management doesn't seem to
1314 be entirely complete, so I guess this will have to wait.
1316 if(setsockopt(...) < 0)
1318 flog(LOG_WARNING, "could not set sock traffic class to %i: %s", tos, strerror(errno));
1324 flog(LOG_WARNING, "could not set TOS on sock of family %i", ufd->d.s.family);
1331 void (*callback)(struct sockaddr *addr, int addrlen, void *data);
1333 struct sockaddr_storage addr;
1337 static void resolvecb(pid_t pid, int status, struct resolvedata *data)
1339 static char buf[80];
1341 struct sockaddr_in *ipv4;
1345 if((ret = read(data->fd, buf, sizeof(buf))) != 4)
1348 data->callback(NULL, 0, data->data);
1350 ipv4 = (struct sockaddr_in *)&data->addr;
1351 memcpy(&ipv4->sin_addr, buf, 4);
1352 data->callback((struct sockaddr *)ipv4, sizeof(*ipv4), data->data);
1356 data->callback(NULL, 0, data->data);
1362 int netresolve(char *addr, void (*callback)(struct sockaddr *addr, int addrlen, void *data), void *data)
1369 struct resolvedata *rdata;
1370 struct sockaddr_in ipv4;
1376 if((p = strchr(addr, ':')) != NULL)
1381 ipv4.sin_family = AF_INET;
1382 ipv4.sin_port = htons(port);
1383 if(inet_aton(addr, &ipv4.sin_addr))
1385 callback((struct sockaddr *)&ipv4, sizeof(ipv4), data);
1387 sigemptyset(&sigset);
1388 sigaddset(&sigset, SIGCHLD);
1389 sigprocmask(SIG_BLOCK, &sigset, NULL);
1390 if((pipe(pfd) < 0) || ((child = fork()) < 0))
1392 sigprocmask(SIG_UNBLOCK, &sigset, NULL);
1397 sigprocmask(SIG_UNBLOCK, &sigset, NULL);
1398 for(i = 3; i < FD_SETSIZE; i++)
1403 signal(SIGALRM, SIG_DFL);
1405 if((he = gethostbyname(addr)) == NULL)
1407 write(pfd[1], he->h_addr_list[0], 4);
1411 fcntl(pfd[0], F_SETFL, fcntl(pfd[0], F_GETFL) | O_NONBLOCK);
1412 rdata = smalloc(sizeof(*rdata));
1414 rdata->callback = callback;
1416 memcpy(&rdata->addr, &ipv4, rdata->addrlen = sizeof(ipv4));
1417 childcallback(child, (void (*)(pid_t, int, void *))resolvecb, rdata);
1418 sigprocmask(SIG_UNBLOCK, &sigset, NULL);
1425 static int getlocalname(int fd, struct sockaddr **namebuf, socklen_t *lenbuf)
1428 struct sockaddr_storage name;
1434 if(getsockname(fd, (struct sockaddr *)&name, &len) < 0)
1436 flog(LOG_ERR, "BUG: alive socket with dead fd in sockgetlocalname (%s)", strerror(errno));
1439 *namebuf = memcpy(smalloc(len), &name, len);
1445 int lstgetlocalname(struct lport *lp, struct sockaddr **namebuf, socklen_t *lenbuf)
1450 return(getlocalname(ufd->fd, namebuf, lenbuf));
1453 int sockgetlocalname(struct socket *sk, struct sockaddr **namebuf, socklen_t *lenbuf)
1458 if(ufd->type != UFD_SOCK) {
1462 return(getlocalname(ufd->fd, namebuf, lenbuf));
1465 static void sethostaddr(struct sockaddr *dst, struct sockaddr *src)
1467 if(dst->sa_family != src->sa_family)
1469 flog(LOG_ERR, "BUG: non-matching socket families in sethostaddr (%i -> %i)", src->sa_family, dst->sa_family);
1472 switch(src->sa_family)
1475 ((struct sockaddr_in *)dst)->sin_addr = ((struct sockaddr_in *)src)->sin_addr;
1478 ((struct sockaddr_in6 *)dst)->sin6_addr = ((struct sockaddr_in6 *)src)->sin6_addr;
1481 flog(LOG_WARNING, "sethostaddr unimplemented for family %i", src->sa_family);
1486 static int makepublic(struct sockaddr *addr)
1490 struct sockaddr *pname;
1492 if((ret = getpublicaddr(addr->sa_family, &pname, &plen)) < 0)
1494 flog(LOG_ERR, "could not get public address: %s", strerror(errno));
1499 sethostaddr(addr, pname);
1504 static int getremotename(int fd, struct sockaddr **namebuf, socklen_t *lenbuf)
1507 struct sockaddr *name;
1509 switch(confgetint("net", "mode")) {
1512 if(!getlocalname(fd, &name, &len)) {
1518 flog(LOG_ERR, "could not get remotely accessible name by any means");
1524 flog(LOG_CRIT, "unknown net mode %i active", confgetint("net", "mode"));
1530 int sockgetremotename(struct socket *sk, struct sockaddr **namebuf, socklen_t *lenbuf)
1535 if(ufd->type != UFD_SOCK) {
1543 return(getremotename(ufd->fd, namebuf, lenbuf));
1546 int lstgetremotename(struct lport *lp, struct sockaddr **namebuf, socklen_t *lenbuf)
1551 return(getremotename(ufd->fd, namebuf, lenbuf));
1554 int sockgetremotename2(struct socket *sk, struct socket *sk2, struct sockaddr **namebuf, socklen_t *lenbuf)
1556 struct sockaddr *name1, *name2;
1557 socklen_t len1, len2;
1558 struct ufd *ufd1, *ufd2;
1560 ufd1 = getskufd(sk);
1561 ufd2 = getskufd(sk2);
1562 if((ufd1->type != UFD_SOCK) || (ufd2->type != UFD_SOCK)) {
1566 if(ufd1->d.s.family != ufd2->d.s.family)
1568 flog(LOG_ERR, "using sockgetremotename2 with sockets of differing family: %i %i", ufd1->d.s.family, ufd2->d.s.family);
1571 if(getremotename(ufd1->fd, &name1, &len1))
1573 if(getremotename(ufd2->fd, &name2, &len2)) {
1577 sethostaddr(name1, name2);
1584 int lstgetremotename2(struct lport *lp, struct socket *sk2, struct sockaddr **namebuf, socklen_t *lenbuf)
1586 struct sockaddr *name1, *name2;
1587 socklen_t len1, len2;
1588 struct ufd *ufd1, *ufd2;
1591 ufd2 = getskufd(sk2);
1592 if(ufd2->type != UFD_SOCK) {
1596 if(ufd1->d.l.family != ufd2->d.s.family)
1598 flog(LOG_ERR, "using lstgetremotename2 with sockets of differing family: %i %i", ufd1->d.l.family, ufd2->d.s.family);
1601 if(getremotename(ufd1->fd, &name1, &len1))
1603 if(getremotename(ufd2->fd, &name2, &len2)) {
1607 sethostaddr(name1, name2);
1614 int getucred(struct socket *sk, uid_t *uid, gid_t *gid)
1619 if(ufd->type != UFD_SOCK) {
1623 if(ufd->d.s.family != AF_UNIX) {
1627 *uid = ufd->d.s.ucred.uid;
1628 *gid = ufd->d.s.ucred.gid;
1632 /* void sockblock(struct socket *sk, int block) */
1634 /* struct ufd *ufd; */
1636 /* ufd = getskufd(sk); */
1637 /* ufd->ignread = block; */
1640 int sockfamily(struct socket *sk)
1645 if(ufd->type != UFD_SOCK) {
1649 return(ufd->d.s.family);
1652 int sockpeeraddr(struct socket *sk, struct sockaddr **namebuf, socklen_t *lenbuf)
1657 if(ufd->type != UFD_SOCK) {
1661 if(ufd->d.s.remote == NULL)
1663 *namebuf = memcpy(smalloc(ufd->d.s.remotelen), ufd->d.s.remote, ufd->d.s.remotelen);
1665 *lenbuf = ufd->d.s.remotelen;
1669 char *formatsockpeer(struct socket *sk)
1671 struct sockaddr *name;
1675 if(sockpeeraddr(sk, &name, &nlen))
1677 ret = formataddress(name, nlen);
1682 int addreq(struct sockaddr *x, struct sockaddr *y)
1684 struct sockaddr_un *u1, *u2;
1685 struct sockaddr_in *n1, *n2;
1687 struct sockaddr_in6 *s1, *s2;
1690 if(x->sa_family != y->sa_family)
1692 switch(x->sa_family) {
1694 u1 = (struct sockaddr_un *)x; u2 = (struct sockaddr_un *)y;
1695 if(strncmp(u1->sun_path, u2->sun_path, sizeof(u1->sun_path)))
1699 n1 = (struct sockaddr_in *)x; n2 = (struct sockaddr_in *)y;
1700 if(n1->sin_port != n2->sin_port)
1702 if(n1->sin_addr.s_addr != n2->sin_addr.s_addr)
1707 s1 = (struct sockaddr_in6 *)x; s2 = (struct sockaddr_in6 *)y;
1708 if(s1->sin6_port != s2->sin6_port)
1710 if(memcmp(s1->sin6_addr.s6_addr, s2->sin6_addr.s6_addr, sizeof(s1->sin6_addr.s6_addr)))
1718 char *formataddress(struct sockaddr *arg, socklen_t arglen)
1720 struct sockaddr_in *ipv4;
1722 struct sockaddr_in6 *ipv6;
1724 static char *ret = NULL;
1730 switch(arg->sa_family)
1733 ret = sstrdup("Unix socket");
1736 ipv4 = (struct sockaddr_in *)arg;
1737 if(inet_ntop(AF_INET, &ipv4->sin_addr, buf, sizeof(buf)) == NULL)
1739 ret = sprintf2("%s:%i", buf, (int)ntohs(ipv4->sin_port));
1743 ipv6 = (struct sockaddr_in6 *)arg;
1744 if(inet_ntop(AF_INET6, &ipv6->sin6_addr, buf, sizeof(buf)) == NULL)
1746 ret = sprintf2("[%s]:%i", buf, (int)ntohs(ipv6->sin6_port));
1750 errno = EPFNOSUPPORT;
1759 * It was very nice to use this, but it seems
1760 * to mess things up, so I guess it has to go... :-(
1763 static int formataddress(FILE *stream, const struct printf_info *info, const void *const *args)
1765 struct sockaddr *arg;
1767 struct sockaddr_un *UNIX; /* Some wise guy has #defined unix with
1768 * lowercase letters to 1, so I do this
1770 struct sockaddr_in *ipv4;
1773 arg = *(struct sockaddr **)(args[0]);
1774 arglen = *(socklen_t *)(args[1]);
1775 switch(arg->sa_family)
1778 UNIX = (struct sockaddr_un *)arg;
1779 ret = fprintf(stream, "%s", UNIX->sun_path);
1782 ipv4 = (struct sockaddr_in *)arg;
1783 ret = fprintf(stream, "%s:%i", inet_ntoa(ipv4->sin_addr), (int)ntohs(ipv4->sin_port));
1787 errno = EPFNOSUPPORT;
1793 static int formataddress_arginfo(const struct printf_info *info, size_t n, int *argtypes)
1796 argtypes[0] = PA_POINTER;
1798 argtypes[1] = PA_INT; /* Sources tell me that socklen_t _must_
1799 * be an int, so I guess this should be
1805 static int init(int hup)
1810 if(register_printf_function('N', formataddress, formataddress_arginfo))
1812 flog(LOG_CRIT, "could not register printf handler %%N: %s", strerror(errno));
1820 static void terminate(void)
1828 static struct module me =
1836 .terminate = terminate