Dolda2000 GitWeb / doldaconnect.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Fix minislot bug.
[doldaconnect.git] / daemon / net.c
CommitLineData
d3372da9 1/*
2 * Dolda Connect - Modular multiuser Direct Connect-style client
3 * Copyright (C) 2004 Fredrik Tolf (fredrik@dolda2000.com)
4 *
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.
9 *
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.
14 *
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
18*/
19/* XXX: Implement SOCKS proxyability */
20
21#ifdef HAVE_CONFIG_H
22#include <config.h>
23#endif
24#include <string.h>
25#include <stdlib.h>
26#include <unistd.h>
27#include <fcntl.h>
28#include <sys/ioctl.h>
29#include <sys/socket.h>
30#include <sys/un.h>
31#include <sys/poll.h>
32#include <arpa/inet.h>
33#include <netinet/in.h>
34#include <netdb.h>
35#include <sys/signal.h>
36#include <printf.h>
37#ifdef HAVE_LINUX_SOCKIOS_H
38#include <linux/sockios.h>
39#endif
40#include <errno.h>
41#include <net/if.h>
42
43#include "conf.h"
44#include "net.h"
45#include "module.h"
46#include "log.h"
47#include "utils.h"
48#include "sysevents.h"
49
50static struct configvar myvars[] =
51{
52 /* 0 = Direct mode, 1 = Passive mode, 2 = SOCKS proxy */
53 {CONF_VAR_INT, "mode", {.num = 0}},
347d6d76 54 {CONF_VAR_BOOL, "reuseaddr", {.num = 0}},
d3372da9 55 /* Only for direct mode */
56 {CONF_VAR_IPV4, "visibleipv4", {.ipv4 = {0}}},
57 {CONF_VAR_STRING, "publicif", {.str = L""}},
b020fb3d 58 /* Diffserv should be supported on IPv4, too, but I don't know the
59 * API to do that. */
60 {CONF_VAR_INT, "diffserv-mincost", {.num = 0}},
61 {CONF_VAR_INT, "diffserv-maxrel", {.num = 0}},
62 {CONF_VAR_INT, "diffserv-maxtp", {.num = 0}},
63 {CONF_VAR_INT, "diffserv-mindelay", {.num = 0}},
d3372da9 64 {CONF_VAR_END}
65};
66
67static struct socket *sockets = NULL;
68int numsocks = 0;
69
70/* XXX: Get autoconf for all this... */
71int getpublicaddr(int af, struct sockaddr **addr, socklen_t *lenbuf)
72{
73 struct sockaddr_in *ipv4;
74 struct configvar *var;
75 void *bufend;
76 int sock;
77 struct ifconf conf;
78 struct ifreq *ifr, req;
79 char *pif;
80
81 if(af == AF_INET)
82 {
83 var = confgetvar("net", "visibleipv4");
84 if(var->val.ipv4.s_addr != 0)
85 {
86 ipv4 = smalloc(sizeof(*ipv4));
87 ipv4->sin_family = AF_INET;
88 ipv4->sin_addr.s_addr = var->val.ipv4.s_addr;
89 *addr = (struct sockaddr *)ipv4;
90 *lenbuf = sizeof(*ipv4);
91 return(0);
92 }
93 if((pif = icwcstombs(confgetstr("net", "publicif"), NULL)) == NULL)
94 {
95 flog(LOG_ERR, "could not convert net.publicif into local charset: %s", strerror(errno));
96 return(-1);
97 }
98 if((sock = socket(AF_INET, SOCK_DGRAM, 0)) < 0)
99 return(-1);
100 conf.ifc_buf = smalloc(conf.ifc_len = 65536);
101 if(ioctl(sock, SIOCGIFCONF, &conf) < 0)
102 {
103 free(conf.ifc_buf);
104 close(sock);
105 return(-1);
106 }
107 bufend = ((char *)conf.ifc_buf) + conf.ifc_len;
108 ipv4 = NULL;
109 for(ifr = conf.ifc_ifcu.ifcu_req; (void *)ifr < bufend; ifr++)
110 {
111 memset(&req, 0, sizeof(req));
112 memcpy(req.ifr_name, ifr->ifr_name, sizeof(ifr->ifr_name));
113 if(ioctl(sock, SIOCGIFFLAGS, &req) < 0)
114 {
115 free(conf.ifc_buf);
116 close(sock);
117 return(-1);
118 }
119 if(!(req.ifr_flags & IFF_UP))
120 continue;
121 if(ifr->ifr_addr.sa_family == AF_INET)
122 {
123 if(ntohl(((struct sockaddr_in *)&ifr->ifr_addr)->sin_addr.s_addr) == 0x7f000001)
124 continue;
125 if(ipv4 == NULL)
126 {
127 ipv4 = smalloc(sizeof(*ipv4));
128 memcpy(ipv4, &ifr->ifr_addr, sizeof(ifr->ifr_addr));
129 } else {
130 free(ipv4);
131 flog(LOG_WARNING, "could not locate an unambiguous interface for determining your public IP address - set net.publicif");
132 errno = ENFILE; /* XXX: There's no appropriate one for this... */
133 return(-1);
134 }
135 }
136 }
137 close(sock);
138 if(ipv4 != NULL)
139 {
140 *addr = (struct sockaddr *)ipv4;
141 *lenbuf = sizeof(*ipv4);
142 return(0);
143 }
144 errno = ENETDOWN;
145 return(-1);
146 }
147 errno = EPFNOSUPPORT;
148 return(-1);
149}
150
151static struct socket *newsock(int type)
152{
153 struct socket *new;
154
155 new = smalloc(sizeof(*new));
156 new->refcount = 2;
157 new->fd = -1;
158 new->isrealsocket = 1;
159 new->family = -1;
160 new->tos = 0;
161 new->type = type;
162 new->state = -1;
163 new->ignread = 0;
164 new->close = 0;
165 new->remote = NULL;
166 new->remotelen = 0;
167 switch(type)
168 {
169 case SOCK_STREAM:
170 new->outbuf.s.buf = NULL;
171 new->outbuf.s.bufsize = 0;
172 new->outbuf.s.datasize = 0;
173 new->inbuf.s.buf = NULL;
174 new->inbuf.s.bufsize = 0;
175 new->inbuf.s.datasize = 0;
176 break;
177 case SOCK_DGRAM:
178 new->outbuf.d.f = new->outbuf.d.l = NULL;
179 new->inbuf.d.f = new->inbuf.d.l = NULL;
180 break;
181 }
182 new->conncb = NULL;
183 new->errcb = NULL;
184 new->readcb = NULL;
185 new->writecb = NULL;
186 new->acceptcb = NULL;
187 new->next = sockets;
188 new->prev = NULL;
189 if(sockets != NULL)
190 sockets->prev = new;
191 sockets = new;
192 numsocks++;
193 return(new);
194}
195
196static struct socket *mksock(int domain, int type)
197{
198 int fd;
199 struct socket *new;
200
201 if((fd = socket(domain, type, 0)) < 0)
202 {
203 flog(LOG_CRIT, "could not create socket: %s", strerror(errno));
204 return(NULL);
205 }
206 new = newsock(type);
207 new->fd = fd;
208 new->family = domain;
209 fcntl(fd, F_SETFL, fcntl(fd, F_GETFL) | O_NONBLOCK);
210 return(new);
211}
212
213struct socket *wrapsock(int fd)
214{
215 struct socket *new;
216
217 new = newsock(SOCK_STREAM);
218 new->fd = fd;
219 new->state = SOCK_EST;
220 new->isrealsocket = 0;
221 fcntl(fd, F_SETFL, fcntl(fd, F_GETFL) | O_NONBLOCK);
222 return(new);
223}
224
225static void unlinksock(struct socket *sk)
226{
227 if(sk->prev != NULL)
228 sk->prev->next = sk->next;
229 if(sk->next != NULL)
230 sk->next->prev = sk->prev;
231 if(sk == sockets)
232 sockets = sk->next;
233 putsock(sk);
234 numsocks--;
235}
236
237void getsock(struct socket *sk)
238{
239 sk->refcount++;
240}
241
242void putsock(struct socket *sk)
243{
244 struct dgrambuf *buf;
245
246 if(--(sk->refcount) == 0)
247 {
248 switch(sk->type)
249 {
250 case SOCK_STREAM:
251 if(sk->outbuf.s.buf != NULL)
252 free(sk->outbuf.s.buf);
253 if(sk->inbuf.s.buf != NULL)
254 free(sk->inbuf.s.buf);
255 break;
256 case SOCK_DGRAM:
257 while((buf = sk->outbuf.d.f) != NULL)
258 {
259 sk->outbuf.d.f = buf->next;
260 free(buf->data);
261 free(buf);
262 }
263 while((buf = sk->inbuf.d.f) != NULL)
264 {
265 sk->inbuf.d.f = buf->next;
266 free(buf->data);
267 free(buf);
268 }
269 break;
270 }
271 if(sk->fd >= 0)
272 close(sk->fd);
273 if(sk->remote != NULL)
274 free(sk->remote);
275 free(sk);
276 }
277}
278
336539c2 279void sockpushdata(struct socket *sk, void *buf, size_t size)
280{
281 switch(sk->type)
282 {
283 case SOCK_STREAM:
284 sizebuf(&sk->inbuf.s.buf, &sk->inbuf.s.bufsize, sk->inbuf.s.datasize + size, 1, 1);
285 memmove(sk->inbuf.s.buf + size, sk->inbuf.s.buf, sk->inbuf.s.datasize);
286 memcpy(sk->inbuf.s.buf, buf, size);
287 sk->inbuf.s.datasize += size;
288 break;
289 case SOCK_DGRAM:
290 /* XXX */
291 break;
292 }
293 return;
294}
295
d3372da9 296void *sockgetinbuf(struct socket *sk, size_t *size)
297{
298 void *buf;
299 struct dgrambuf *dbuf;
300
301 switch(sk->type)
302 {
303 case SOCK_STREAM:
304 if((sk->inbuf.s.buf == NULL) || (sk->inbuf.s.datasize == 0))
305 {
306 *size = 0;
307 return(NULL);
308 }
309 buf = sk->inbuf.s.buf;
310 *size = sk->inbuf.s.datasize;
311 sk->inbuf.s.buf = NULL;
312 sk->inbuf.s.bufsize = sk->inbuf.s.datasize = 0;
313 return(buf);
314 case SOCK_DGRAM:
315 if((dbuf = sk->inbuf.d.f) == NULL)
316 return(NULL);
317 sk->inbuf.d.f = dbuf->next;
318 if(dbuf->next == NULL)
319 sk->inbuf.d.l = NULL;
320 buf = dbuf->data;
321 *size = dbuf->size;
322 free(dbuf->addr);
323 free(dbuf);
324 return(buf);
325 }
326 return(NULL);
327}
328
329static void sockrecv(struct socket *sk)
330{
331 int ret, inq;
332 struct dgrambuf *dbuf;
333
334 switch(sk->type)
335 {
336 case SOCK_STREAM:
337#if defined(HAVE_LINUX_SOCKIOS_H) && defined(SIOCINQ)
338 /* SIOCINQ is Linux-specific AFAIK, but I really have no idea
339 * how to read the inqueue size on other OSs */
340 if(ioctl(sk->fd, SIOCINQ, &inq))
341 {
342 /* I don't really know what could go wrong here, so let's
343 * assume it's transient. */
344 flog(LOG_WARNING, "SIOCINQ return %s on socket %i, falling back to 2048 bytes", strerror(errno), sk->fd);
345 inq = 2048;
346 }
347#else
348 inq = 2048;
349#endif
350 if(inq > 65536)
351 inq = 65536;
352 sizebuf(&sk->inbuf.s.buf, &sk->inbuf.s.bufsize, sk->inbuf.s.datasize + inq, 1, 1);
353 ret = read(sk->fd, sk->inbuf.s.buf + sk->inbuf.s.datasize, inq);
354 if(ret < 0)
355 {
356 if((errno == EINTR) || (errno == EAGAIN))
357 return;
358 if(sk->errcb != NULL)
359 sk->errcb(sk, errno, sk->data);
360 closesock(sk);
361 return;
362 }
363 if(ret == 0)
364 {
365 if(sk->errcb != NULL)
366 sk->errcb(sk, 0, sk->data);
367 closesock(sk);
368 return;
369 }
370 sk->inbuf.s.datasize += ret;
371 if(sk->readcb != NULL)
372 sk->readcb(sk, sk->data);
373 break;
374 case SOCK_DGRAM:
375 if(ioctl(sk->fd, SIOCINQ, &inq))
376 {
377 /* I don't really know what could go wrong here, so let's
378 * assume it's transient. */
379 flog(LOG_WARNING, "SIOCINQ return %s on socket %i", strerror(errno), sk->fd);
380 return;
381 }
382 dbuf = smalloc(sizeof(*dbuf));
383 dbuf->data = smalloc(inq);
384 dbuf->addr = smalloc(dbuf->addrlen = sizeof(struct sockaddr_storage));
385 ret = recvfrom(sk->fd, dbuf->data, inq, 0, dbuf->addr, &dbuf->addrlen);
386 if(ret < 0)
387 {
388 free(dbuf->addr);
389 free(dbuf->data);
390 free(dbuf);
391 if((errno == EINTR) || (errno == EAGAIN))
392 return;
393 if(sk->errcb != NULL)
394 sk->errcb(sk, errno, sk->data);
395 closesock(sk);
396 return;
397 }
398 /* On UDP/IPv[46], ret == 0 doesn't mean EOF (since UDP can't
399 * have EOF), but rather an empty packet. I don't know if any
400 * other potential DGRAM protocols might have an EOF
401 * condition, so let's play safe. */
402 if(ret == 0)
403 {
404 free(dbuf->addr);
405 free(dbuf->data);
406 free(dbuf);
407 if(!((sk->family == AF_INET) || (sk->family == AF_INET6)))
408 {
409 if(sk->errcb != NULL)
410 sk->errcb(sk, 0, sk->data);
411 closesock(sk);
412 }
413 return;
414 }
415 dbuf->addr = srealloc(dbuf->addr, dbuf->addrlen);
416 dbuf->data = srealloc(dbuf->data, dbuf->size = ret);
417 dbuf->next = NULL;
418 if(sk->inbuf.d.l != NULL)
419 sk->inbuf.d.l->next = dbuf;
420 else
421 sk->inbuf.d.f = dbuf;
422 sk->inbuf.d.l = dbuf;
423 if(sk->readcb != NULL)
424 sk->readcb(sk, sk->data);
425 break;
426 }
427}
428
429static void sockflush(struct socket *sk)
430{
431 int ret;
432 struct dgrambuf *dbuf;
433
434 switch(sk->type)
435 {
436 case SOCK_STREAM:
437 if(sk->isrealsocket)
438 ret = send(sk->fd, sk->outbuf.s.buf, sk->outbuf.s.datasize, MSG_DONTWAIT | MSG_NOSIGNAL);
439 else
440 ret = write(sk->fd, sk->outbuf.s.buf, sk->outbuf.s.datasize);
441 if(ret < 0)
442 {
443 /* For now, assume transient error, since
444 * the socket is polled for errors */
445 break;
446 }
447 if(ret > 0)
448 {
449 memmove(sk->outbuf.s.buf, ((char *)sk->outbuf.s.buf) + ret, sk->outbuf.s.datasize -= ret);
450 if(sk->writecb != NULL)
451 sk->writecb(sk, sk->data);
452 }
453 break;
454 case SOCK_DGRAM:
455 dbuf = sk->outbuf.d.f;
456 if((sk->outbuf.d.f = dbuf->next) == NULL)
457 sk->outbuf.d.l = NULL;
458 sendto(sk->fd, dbuf->data, dbuf->size, MSG_DONTWAIT | MSG_NOSIGNAL, dbuf->addr, dbuf->addrlen);
459 free(dbuf->data);
460 free(dbuf->addr);
461 free(dbuf);
462 if(sk->writecb != NULL)
463 sk->writecb(sk, sk->data);
464 break;
465 }
466}
467
468void closesock(struct socket *sk)
469{
470 sk->state = SOCK_STL;
471 close(sk->fd);
472 sk->fd = -1;
473 sk->close = 0;
474}
475
476void sockqueue(struct socket *sk, void *data, size_t size)
477{
478 struct dgrambuf *new;
479
480 if(sk->state == SOCK_STL)
481 return;
482 switch(sk->type)
483 {
484 case SOCK_STREAM:
485 sizebuf(&(sk->outbuf.s.buf), &(sk->outbuf.s.bufsize), sk->outbuf.s.datasize + size, 1, 1);
486 memcpy(sk->outbuf.s.buf + sk->outbuf.s.datasize, data, size);
487 sk->outbuf.s.datasize += size;
488 break;
489 case SOCK_DGRAM:
490 if(sk->remote == NULL)
491 return;
492 new = smalloc(sizeof(*new));
493 new->next = NULL;
494 memcpy(new->data = smalloc(size), data, new->size = size);
495 memcpy(new->addr = smalloc(sk->remotelen), sk->remote, new->addrlen = sk->remotelen);
496 if(sk->outbuf.d.l == NULL)
497 {
498 sk->outbuf.d.l = sk->outbuf.d.f = new;
499 } else {
500 sk->outbuf.d.l->next = new;
501 sk->outbuf.d.l = new;
502 }
503 break;
504 }
505}
506
507size_t sockgetdatalen(struct socket *sk)
508{
509 struct dgrambuf *b;
510 size_t ret;
511
512 switch(sk->type)
513 {
514 case SOCK_STREAM:
515 ret = sk->inbuf.s.datasize;
516 break;
517 case SOCK_DGRAM:
518 ret = 0;
519 for(b = sk->inbuf.d.f; b != NULL; b = b->next)
520 ret += b->size;
521 break;
522 }
523 return(ret);
524}
525
526size_t sockqueuesize(struct socket *sk)
527{
528 struct dgrambuf *b;
529 size_t ret;
530
531 switch(sk->type)
532 {
533 case SOCK_STREAM:
534 ret = sk->outbuf.s.datasize;
535 break;
536 case SOCK_DGRAM:
537 ret = 0;
538 for(b = sk->outbuf.d.f; b != NULL; b = b->next)
539 ret += b->size;
540 break;
541 }
542 return(ret);
543}
544
545struct socket *netcslisten(int type, struct sockaddr *name, socklen_t namelen, void (*func)(struct socket *, struct socket *, void *), void *data)
546{
547 struct socket *sk;
347d6d76 548 int intbuf;
d3372da9 549
550 if(confgetint("net", "mode") == 1)
551 {
552 errno = EOPNOTSUPP;
553 return(NULL);
554 }
555 /* I don't know if this is actually correct (it probably isn't),
556 * but since, at on least Linux systems, PF_* are specifically
557 * #define'd to their AF_* counterparts, it allows for a severely
558 * smoother implementation. If it breaks something on your
559 * platform, please tell me so.
560 */
561 if(confgetint("net", "mode") == 0)
562 {
563 if((sk = mksock(name->sa_family, type)) == NULL)
564 return(NULL);
565 sk->state = SOCK_LST;
347d6d76 566 if(confgetint("net", "reuseaddr"))
567 {
568 intbuf = 1;
569 setsockopt(sk->fd, SOL_SOCKET, SO_REUSEADDR, &intbuf, sizeof(intbuf));
570 }
d3372da9 571 if(bind(sk->fd, name, namelen) < 0)
572 {
573 putsock(sk);
574 return(NULL);
575 }
576 if(listen(sk->fd, 16) < 0)
577 {
578 putsock(sk);
579 return(NULL);
580 }
581 sk->acceptcb = func;
582 sk->data = data;
583 return(sk);
584 }
585 errno = EOPNOTSUPP;
586 return(NULL);
587}
588
589/*
590 * The difference between netcslisten() and netcslistenlocal() is that
591 * netcslistenlocal() always listens on the local host, instead of
592 * following proxy/passive mode directions. It is suitable for eg. the
593 * UI channel, while the file sharing networks should, naturally, use
594 * netcslisten() instead.
595*/
596
597struct socket *netcslistenlocal(int type, struct sockaddr *name, socklen_t namelen, void (*func)(struct socket *, struct socket *, void *), void *data)
598{
599 struct socket *sk;
66c517d2 600 int intbuf;
d3372da9 601
602 /* I don't know if this is actually correct (it probably isn't),
603 * but since, at on least Linux systems, PF_* are specifically
604 * #define'd to their AF_* counterparts, it allows for a severely
605 * smoother implementation. If it breaks something on your
606 * platform, please tell me so.
607 */
608 if((sk = mksock(name->sa_family, type)) == NULL)
609 return(NULL);
610 sk->state = SOCK_LST;
687b2ee2 611 if(confgetint("net", "reuseaddr"))
612 {
613 intbuf = 1;
614 setsockopt(sk->fd, SOL_SOCKET, SO_REUSEADDR, &intbuf, sizeof(intbuf));
615 }
d3372da9 616 if(bind(sk->fd, name, namelen) < 0)
617 {
618 putsock(sk);
619 return(NULL);
620 }
621 if(listen(sk->fd, 16) < 0)
622 {
623 putsock(sk);
624 return(NULL);
625 }
626 sk->acceptcb = func;
627 sk->data = data;
628 return(sk);
629}
630
631struct socket *netcsdgram(struct sockaddr *name, socklen_t namelen)
632{
633 struct socket *sk;
634 int mode;
635
636 mode = confgetint("net", "mode");
637 if((mode == 0) || (mode == 1))
638 {
639 if((sk = mksock(name->sa_family, SOCK_DGRAM)) == NULL)
640 return(NULL);
641 if(bind(sk->fd, name, namelen) < 0)
642 {
643 putsock(sk);
644 return(NULL);
645 }
646 sk->state = SOCK_EST;
647 return(sk);
648 }
649 errno = EOPNOTSUPP;
650 return(NULL);
651}
652
653struct socket *netdupsock(struct socket *sk)
654{
655 struct socket *newsk;
656
657 newsk = newsock(sk->type);
658 if((newsk->fd = dup(sk->fd)) < 0)
659 {
660 flog(LOG_WARNING, "could not dup() socket: %s", strerror(errno));
661 putsock(newsk);
662 return(NULL);
663 }
664 newsk->state = sk->state;
665 newsk->ignread = sk->ignread;
666 if(sk->remote != NULL)
667 memcpy(newsk->remote = smalloc(sk->remotelen), sk->remote, newsk->remotelen = sk->remotelen);
668 return(newsk);
669}
670
671void netdgramconn(struct socket *sk, struct sockaddr *addr, socklen_t addrlen)
672{
673 if(sk->remote != NULL)
674 free(sk->remote);
675 memcpy(sk->remote = smalloc(addrlen), addr, sk->remotelen = addrlen);
676 sk->ignread = 1;
677}
678
679struct socket *netcsconn(struct sockaddr *addr, socklen_t addrlen, void (*func)(struct socket *, int, void *), void *data)
680{
681 struct socket *sk;
682 int mode;
683
684 mode = confgetint("net", "mode");
685 if((mode == 0) || (mode == 1))
686 {
687 if((sk = mksock(addr->sa_family, SOCK_STREAM)) == NULL)
688 return(NULL);
689 memcpy(sk->remote = smalloc(addrlen), addr, sk->remotelen = addrlen);
690 if(!connect(sk->fd, addr, addrlen))
691 {
692 sk->state = SOCK_EST;
693 func(sk, 0, data);
694 return(sk);
695 }
696 if(errno == EINPROGRESS)
697 {
698 sk->state = SOCK_SYN;
699 sk->conncb = func;
700 sk->data = data;
701 return(sk);
702 }
703 putsock(sk);
704 return(NULL);
705 }
706 errno = EOPNOTSUPP;
707 return(NULL);
708}
709
710int pollsocks(int timeout)
711{
712 int i, num, ret, retlen;
713 int newfd;
714 struct pollfd *pfds;
715 struct socket *sk, *next, *newsk;
716 struct sockaddr_storage ss;
717 socklen_t sslen;
718
719 pfds = smalloc(sizeof(*pfds) * (num = numsocks));
720 for(i = 0, sk = sockets; i < num; sk = sk->next)
721 {
722 if(sk->state == SOCK_STL)
723 {
724 num--;
725 continue;
726 }
727 pfds[i].fd = sk->fd;
728 pfds[i].events = 0;
729 if(!sk->ignread)
730 pfds[i].events |= POLLIN;
731 if((sk->state == SOCK_SYN) || (sockqueuesize(sk) > 0))
732 pfds[i].events |= POLLOUT;
733 pfds[i].revents = 0;
734 i++;
735 }
736 ret = poll(pfds, num, timeout);
737 if(ret < 0)
738 {
739 if(errno != EINTR)
740 {
741 flog(LOG_CRIT, "pollsocks: poll errored out: %s", strerror(errno));
742 /* To avoid CPU hogging in case it's bad, which it
743 * probably is. */
744 sleep(1);
745 }
746 free(pfds);
747 return(1);
748 }
749 for(sk = sockets; sk != NULL; sk = next)
750 {
751 next = sk->next;
752 for(i = 0; i < num; i++)
753 {
754 if(pfds[i].fd == sk->fd)
755 break;
756 }
757 if(i == num)
758 continue;
759 switch(sk->state)
760 {
761 case SOCK_LST:
762 if(pfds[i].revents & POLLIN)
763 {
764 sslen = sizeof(ss);
765 if((newfd = accept(sk->fd, (struct sockaddr *)&ss, &sslen)) < 0)
766 {
767 if(sk->errcb != NULL)
768 sk->errcb(sk, errno, sk->data);
769 }
770 newsk = newsock(sk->type);
771 newsk->fd = newfd;
772 newsk->family = sk->family;
773 newsk->state = SOCK_EST;
774 memcpy(newsk->remote = smalloc(sslen), &ss, sslen);
775 newsk->remotelen = sslen;
776 putsock(newsk);
777 if(sk->acceptcb != NULL)
778 sk->acceptcb(sk, newsk, sk->data);
779 }
780 if(pfds[i].revents & POLLERR)
781 {
782 retlen = sizeof(ret);
783 getsockopt(sk->fd, SOL_SOCKET, SO_ERROR, &ret, &retlen);
784 if(sk->errcb != NULL)
785 sk->errcb(sk, ret, sk->data);
786 continue;
787 }
788 break;
789 case SOCK_SYN:
790 if(pfds[i].revents & POLLERR)
791 {
792 retlen = sizeof(ret);
793 getsockopt(sk->fd, SOL_SOCKET, SO_ERROR, &ret, &retlen);
794 if(sk->conncb != NULL)
795 sk->conncb(sk, ret, sk->data);
796 closesock(sk);
797 continue;
798 }
799 if(pfds[i].revents & (POLLIN | POLLOUT))
800 {
801 sk->state = SOCK_EST;
802 if(sk->conncb != NULL)
803 sk->conncb(sk, 0, sk->data);
804 }
805 break;
806 case SOCK_EST:
807 if(pfds[i].revents & POLLERR)
808 {
809 retlen = sizeof(ret);
810 getsockopt(sk->fd, SOL_SOCKET, SO_ERROR, &ret, &retlen);
811 if(sk->errcb != NULL)
812 sk->errcb(sk, ret, sk->data);
813 closesock(sk);
814 continue;
815 }
816 if(pfds[i].revents & POLLIN)
817 sockrecv(sk);
818 if(pfds[i].revents & POLLOUT)
819 {
820 if(sockqueuesize(sk) > 0)
821 sockflush(sk);
822 }
823 break;
824 }
825 if(pfds[i].revents & POLLNVAL)
826 {
827 flog(LOG_CRIT, "BUG: stale socket struct on fd %i", sk->fd);
828 sk->state = SOCK_STL;
829 unlinksock(sk);
830 continue;
831 }
832 if(pfds[i].revents & POLLHUP)
833 {
834 if(sk->errcb != NULL)
835 sk->errcb(sk, 0, sk->data);
836 closesock(sk);
837 unlinksock(sk);
838 continue;
839 }
840 }
841 free(pfds);
842 for(sk = sockets; sk != NULL; sk = next)
843 {
844 next = sk->next;
845 if(sk->refcount == 1 && (sockqueuesize(sk) == 0))
846 {
847 unlinksock(sk);
848 continue;
849 }
850 if(sk->close && (sockqueuesize(sk) == 0))
851 closesock(sk);
852 if(sk->state == SOCK_STL)
853 {
854 unlinksock(sk);
855 continue;
856 }
857 }
858 return(1);
859}
860
861int socksettos(struct socket *sk, int tos)
862{
b020fb3d 863 int buf;
864
d3372da9 865 if(sk->family == AF_INET)
866 {
b020fb3d 867 switch(tos)
868 {
869 case SOCK_TOS_MINCOST:
18c1ae1d 870 buf = 0x02;
b020fb3d 871 break;
872 case SOCK_TOS_MAXREL:
18c1ae1d 873 buf = 0x04;
b020fb3d 874 break;
875 case SOCK_TOS_MAXTP:
18c1ae1d 876 buf = 0x08;
b020fb3d 877 break;
878 case SOCK_TOS_MINDELAY:
18c1ae1d 879 buf = 0x10;
b020fb3d 880 break;
881 default:
882 flog(LOG_WARNING, "attempted to set unknown TOS value %i to IPv4 sock", tos);
883 return(-1);
884 }
885 if(setsockopt(sk->fd, SOL_IP, IP_TOS, &buf, sizeof(buf)) < 0)
d3372da9 886 {
887 flog(LOG_WARNING, "could not set sock TOS to %i: %s", tos, strerror(errno));
888 return(-1);
889 }
890 return(0);
891 }
b020fb3d 892 if(sk->family == AF_INET6)
893 {
894 switch(tos)
895 {
896 case SOCK_TOS_MINCOST:
897 buf = confgetint("net", "diffserv-mincost");
898 break;
899 case SOCK_TOS_MAXREL:
900 buf = confgetint("net", "diffserv-maxrel");
901 break;
902 case SOCK_TOS_MAXTP:
903 buf = confgetint("net", "diffserv-maxtp");
904 break;
905 case SOCK_TOS_MINDELAY:
906 buf = confgetint("net", "diffserv-mindelay");
907 break;
908 default:
909 flog(LOG_WARNING, "attempted to set unknown TOS value %i to IPv4 sock", tos);
910 return(-1);
911 }
912 /*
913 On Linux, the API IPv6 flow label management doesn't seem to
914 be entirely complete, so I guess this will have to wait.
915
916 if(setsockopt(...) < 0)
917 {
918 flog(LOG_WARNING, "could not set sock traffic class to %i: %s", tos, strerror(errno));
919 return(-1);
920 }
921 */
922 return(0);
923 }
d3372da9 924 flog(LOG_WARNING, "could not set TOS on sock of family %i", sk->family);
925 return(1);
926}
927
928struct resolvedata
929{
930 int fd;
931 void (*callback)(struct sockaddr *addr, int addrlen, void *data);
932 void *data;
933 struct sockaddr_storage addr;
934 int addrlen;
935};
936
937static void resolvecb(pid_t pid, int status, struct resolvedata *data)
938{
939 static char buf[80];
940 int ret;
941 struct sockaddr_in *ipv4;
942
943 if(!status)
944 {
945 if((ret = read(data->fd, buf, sizeof(buf))) != 4)
946 {
947 errno = ENONET;
948 data->callback(NULL, 0, data->data);
949 } else {
950 ipv4 = (struct sockaddr_in *)&data->addr;
951 memcpy(&ipv4->sin_addr, buf, 4);
952 data->callback((struct sockaddr *)ipv4, sizeof(*ipv4), data->data);
953 }
954 } else {
955 errno = ENONET;
956 data->callback(NULL, 0, data->data);
957 }
958 close(data->fd);
959 free(data);
960}
961
962int netresolve(char *addr, void (*callback)(struct sockaddr *addr, int addrlen, void *data), void *data)
963{
964 int i;
965 char *p;
966 int port;
967 int pfd[2];
968 pid_t child;
969 struct resolvedata *rdata;
970 struct sockaddr_in ipv4;
971 struct hostent *he;
972 sigset_t sigset;
973
974 /* IPv4 */
975 port = -1;
976 if((p = strchr(addr, ':')) != NULL)
977 {
978 *p = 0;
979 port = atoi(p + 1);
980 }
981 ipv4.sin_family = AF_INET;
982 ipv4.sin_port = htons(port);
983 if(inet_aton(addr, &ipv4.sin_addr))
984 {
985 callback((struct sockaddr *)&ipv4, sizeof(ipv4), data);
986 } else {
987 sigemptyset(&sigset);
988 sigaddset(&sigset, SIGCHLD);
989 sigprocmask(SIG_BLOCK, &sigset, NULL);
990 if((pipe(pfd) < 0) || ((child = fork()) < 0))
991 {
992 sigprocmask(SIG_UNBLOCK, &sigset, NULL);
993 return(-1);
994 }
995 if(child == 0)
996 {
997 sigprocmask(SIG_UNBLOCK, &sigset, NULL);
998 for(i = 3; i < FD_SETSIZE; i++)
999 {
1000 if(i != pfd[1])
1001 close(i);
1002 }
1003 signal(SIGALRM, SIG_DFL);
1004 alarm(30);
1005 if((he = gethostbyname(addr)) == NULL)
1006 exit(1);
1007 write(pfd[1], he->h_addr_list[0], 4);
1008 exit(0);
1009 } else {
1010 close(pfd[1]);
1011 fcntl(pfd[0], F_SETFL, fcntl(pfd[0], F_GETFL) | O_NONBLOCK);
1012 rdata = smalloc(sizeof(*rdata));
1013 rdata->fd = pfd[0];
1014 rdata->callback = callback;
1015 rdata->data = data;
1016 memcpy(&rdata->addr, &ipv4, rdata->addrlen = sizeof(ipv4));
1017 childcallback(child, (void (*)(pid_t, int, void *))resolvecb, rdata);
1018 sigprocmask(SIG_UNBLOCK, &sigset, NULL);
1019 return(1);
1020 }
1021 }
1022 return(0);
1023}
1024
1025int sockgetlocalname(struct socket *sk, struct sockaddr **namebuf, socklen_t *lenbuf)
1026{
1027 socklen_t len;
1028 struct sockaddr_storage name;
1029
1030 *namebuf = NULL;
1031 if((sk->state == SOCK_STL) || (sk->fd < 0))
1032 return(-1);
1033 len = sizeof(name);
1034 if(getsockname(sk->fd, (struct sockaddr *)&name, &len) < 0)
1035 {
1036 flog(LOG_ERR, "BUG: alive socket with dead fd in sockgetlocalname");
1037 return(-1);
1038 }
1039 *namebuf = memcpy(smalloc(len), &name, len);
1040 *lenbuf = len;
1041 return(0);
1042}
1043
1044int sockgetremotename(struct socket *sk, struct sockaddr **namebuf, socklen_t *lenbuf)
1045{
1046 socklen_t len;
1047 struct sockaddr_storage name;
1048 struct sockaddr_in *ipv4;
1049 struct sockaddr *pname;
1050 socklen_t pnamelen;
1051
1052 switch(confgetint("net", "mode"))
1053 {
1054 case 0:
1055 *namebuf = NULL;
1056 if((sk->state == SOCK_STL) || (sk->fd < 0))
1057 return(-1);
1058 len = sizeof(name);
1059 if(getsockname(sk->fd, (struct sockaddr *)&name, &len) < 0)
1060 {
1061 flog(LOG_ERR, "BUG: alive socket with dead fd in sockgetremotename");
1062 return(-1);
1063 }
1064 if(name.ss_family == AF_INET)
1065 {
1066 ipv4 = (struct sockaddr_in *)&name;
1067 if(getpublicaddr(AF_INET, &pname, &pnamelen) < 0)
1068 {
1069 flog(LOG_WARNING, "could not determine public IP address - strange things may happen");
1070 return(-1);
1071 }
1072 ipv4->sin_addr.s_addr = ((struct sockaddr_in *)pname)->sin_addr.s_addr;
1073 free(pname);
1074 }
1075 *namebuf = memcpy(smalloc(len), &name, len);
1076 *lenbuf = len;
1077 return(0);
1078 case 1:
1079 errno = EOPNOTSUPP;
1080 return(-1);
1081 default:
1082 flog(LOG_CRIT, "unknown net mode %i active", confgetint("net", "mode"));
1083 errno = EOPNOTSUPP;
1084 return(-1);
1085 }
1086}
1087
1088char *formataddress(struct sockaddr *arg, socklen_t arglen)
1089{
1090 struct sockaddr_un *UNIX; /* Some wise guy has #defined unix with
1091 * lowercase letters to 1, so I do this
1092 * instead. */
1093 struct sockaddr_in *ipv4;
1094#ifdef HAVE_IPV6
1095 struct sockaddr_in6 *ipv6;
1096#endif
1097 static char *ret = NULL;
1098 char buf[1024];
1099
1100 if(ret != NULL)
1101 free(ret);
1102 ret = NULL;
1103 switch(arg->sa_family)
1104 {
1105 case AF_UNIX:
1106 UNIX = (struct sockaddr_un *)arg;
1107 ret = sprintf2("%s", UNIX->sun_path);
1108 break;
1109 case AF_INET:
1110 ipv4 = (struct sockaddr_in *)arg;
1111 if(inet_ntop(AF_INET, &ipv4->sin_addr, buf, sizeof(buf)) == NULL)
1112 return(NULL);
1113 ret = sprintf2("%s:%i", buf, (int)ntohs(ipv4->sin_port));
1114 break;
1115#ifdef HAVE_IPV6
1116 case AF_INET6:
1117 ipv6 = (struct sockaddr_in6 *)arg;
1118 if(inet_ntop(AF_INET6, &ipv6->sin6_addr, buf, sizeof(buf)) == NULL)
1119 return(NULL);
1120 ret = sprintf2("%s:%i", buf, (int)ntohs(ipv6->sin6_port));
1121 break;
1122#endif
1123 default:
1124 errno = EPFNOSUPPORT;
1125 break;
1126 }
1127 return(ret);
1128}
1129
1130#if 0
1131
1132/*
1133 * It was very nice to use this, but it seems
1134 * to mess things up, so I guess it has to go... :-(
1135 */
1136
1137static int formataddress(FILE *stream, const struct printf_info *info, const void *const *args)
1138{
1139 struct sockaddr *arg;
1140 socklen_t arglen;
1141 struct sockaddr_un *UNIX; /* Some wise guy has #defined unix with
1142 * lowercase letters to 1, so I do this
1143 * instead. */
1144 struct sockaddr_in *ipv4;
1145 int ret;
1146
1147 arg = *(struct sockaddr **)(args[0]);
1148 arglen = *(socklen_t *)(args[1]);
1149 switch(arg->sa_family)
1150 {
1151 case AF_UNIX:
1152 UNIX = (struct sockaddr_un *)arg;
1153 ret = fprintf(stream, "%s", UNIX->sun_path);
1154 break;
1155 case AF_INET:
1156 ipv4 = (struct sockaddr_in *)arg;
1157 ret = fprintf(stream, "%s:%i", inet_ntoa(ipv4->sin_addr), (int)ntohs(ipv4->sin_port));
1158 break;
1159 default:
1160 ret = -1;
1161 errno = EPFNOSUPPORT;
1162 break;
1163 }
1164 return(ret);
1165}
1166
1167static int formataddress_arginfo(const struct printf_info *info, size_t n, int *argtypes)
1168{
1169 if(n > 0)
1170 argtypes[0] = PA_POINTER;
1171 if(n > 1)
1172 argtypes[1] = PA_INT; /* Sources tell me that socklen_t _must_
1173 * be an int, so I guess this should be
1174 * safe. */
1175 return(2);
1176}
1177#endif
1178
1179static int init(int hup)
1180{
1181 if(!hup)
1182 {
1183 /*
1184 if(register_printf_function('N', formataddress, formataddress_arginfo))
1185 {
1186 flog(LOG_CRIT, "could not register printf handler %%N: %s", strerror(errno));
1187 return(1);
1188 }
1189 */
1190 }
1191 return(0);
1192}
1193
1194static void terminate(void)
1195{
1196 while(sockets != NULL)
1197 unlinksock(sockets);
1198}
1199
1200static struct module me =
1201{
1202 .name = "net",
1203 .conf =
1204 {
1205 .vars = myvars
1206 },
1207 .init = init,
1208 .terminate = terminate
1209};
1210
1211MODULE(me)
Dolda Connect