faithd.c revision 1.18 1 /* $NetBSD: faithd.c,v 1.18 2001/03/20 01:13:46 itojun Exp $ */
2 /* $KAME: faithd.c,v 1.38 2001/02/27 06:46:52 itojun Exp $ */
3
4 /*
5 * Copyright (C) 1997 and 1998 WIDE Project.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the name of the project nor the names of its contributors
17 * may be used to endorse or promote products derived from this software
18 * without specific prior written permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 * SUCH DAMAGE.
31 */
32
33 /*
34 * User level translator from IPv6 to IPv4.
35 *
36 * Usage: faithd [<port> <progpath> <arg1(progname)> <arg2> ...]
37 * e.g. faithd telnet /usr/local/v6/sbin/telnetd telnetd
38 */
39 #define HAVE_GETIFADDRS
40
41 #include <sys/param.h>
42 #include <sys/types.h>
43 #include <sys/sysctl.h>
44 #include <sys/socket.h>
45 #include <sys/wait.h>
46 #include <sys/stat.h>
47 #include <sys/time.h>
48 #include <sys/ioctl.h>
49 #ifdef __FreeBSD__
50 #include <libutil.h>
51 #endif
52
53 #include <stdio.h>
54 #include <stdlib.h>
55 #include <stdarg.h>
56 #include <string.h>
57 #include <syslog.h>
58 #include <unistd.h>
59 #include <errno.h>
60 #include <signal.h>
61 #include <fcntl.h>
62 #include <termios.h>
63
64 #include <net/if_types.h>
65 #ifdef IFT_FAITH
66 # define USE_ROUTE
67 # include <net/if.h>
68 # include <net/route.h>
69 # include <net/if_dl.h>
70 #endif
71
72 #include <netinet/in.h>
73 #include <arpa/inet.h>
74 #include <netdb.h>
75 #ifdef HAVE_GETIFADDRS
76 #include <ifaddrs.h>
77 #endif
78
79 #ifdef FAITH4
80 #include <resolv.h>
81 #include <arpa/nameser.h>
82 #ifndef FAITH_NS
83 #define FAITH_NS "FAITH_NS"
84 #endif
85 #endif
86
87 #include "faithd.h"
88 #include "prefix.h"
89
90 char *serverpath = NULL;
91 char *serverarg[MAXARGV + 1];
92 static char *faithdname = NULL;
93 char logname[BUFSIZ];
94 char procname[BUFSIZ];
95 struct myaddrs {
96 struct myaddrs *next;
97 struct sockaddr *addr;
98 };
99 struct myaddrs *myaddrs = NULL;
100 static char *service;
101 #ifdef USE_ROUTE
102 static int sockfd = 0;
103 #endif
104 int dflag = 0;
105 static int pflag = 0;
106 static int inetd = 0;
107 static char *configfile = NULL;
108
109 int main __P((int, char **));
110 static int inetd_main __P((int, char **));
111 static int daemon_main __P((int, char **));
112 static void play_service __P((int));
113 static void play_child __P((int, struct sockaddr *));
114 static int faith_prefix __P((struct sockaddr *));
115 static int map6to4 __P((struct sockaddr_in6 *, struct sockaddr_in *));
116 #ifdef FAITH4
117 static int map4to6 __P((struct sockaddr_in *, struct sockaddr_in6 *));
118 #endif
119 static void sig_child __P((int));
120 static void sig_terminate __P((int));
121 static void start_daemon __P((void));
122 static void exit_stderr __P((const char *, ...))
123 __attribute__((__format__(__printf__, 1, 2)));
124 #ifndef HAVE_GETIFADDRS
125 static unsigned int if_maxindex __P((void));
126 #endif
127 static void grab_myaddrs __P((void));
128 static void free_myaddrs __P((void));
129 static void update_myaddrs __P((void));
130 static void usage __P((void));
131
132 int
133 main(int argc, char **argv)
134 {
135
136 /*
137 * Initializing stuff
138 */
139
140 faithdname = strrchr(argv[0], '/');
141 if (faithdname)
142 faithdname++;
143 else
144 faithdname = argv[0];
145
146 if (strcmp(faithdname, "faithd") != 0) {
147 inetd = 1;
148 return inetd_main(argc, argv);
149 } else
150 return daemon_main(argc, argv);
151 }
152
153 static int
154 inetd_main(int argc, char **argv)
155 {
156 char path[MAXPATHLEN];
157 struct sockaddr_storage me;
158 struct sockaddr_storage from;
159 int melen, fromlen;
160 int i;
161 int error;
162 const int on = 1;
163 char sbuf[NI_MAXSERV], snum[NI_MAXSERV];
164
165 if (config_load(configfile) < 0 && configfile) {
166 exit_failure("could not load config file");
167 /*NOTREACHED*/
168 }
169
170 if (strrchr(argv[0], '/') == NULL)
171 snprintf(path, sizeof(path), "%s/%s", DEFAULT_DIR, argv[0]);
172 else
173 snprintf(path, sizeof(path), "%s", argv[0]);
174
175 #ifdef USE_ROUTE
176 grab_myaddrs();
177
178 sockfd = socket(PF_ROUTE, SOCK_RAW, PF_UNSPEC);
179 if (sockfd < 0) {
180 exit_failure("socket(PF_ROUTE): %s", ERRSTR);
181 /*NOTREACHED*/
182 }
183 #endif
184
185 melen = sizeof(me);
186 if (getsockname(STDIN_FILENO, (struct sockaddr *)&me, &melen) < 0) {
187 exit_failure("getsockname: %s", ERRSTR);
188 /*NOTREACHED*/
189 }
190 fromlen = sizeof(from);
191 if (getpeername(STDIN_FILENO, (struct sockaddr *)&from, &fromlen) < 0) {
192 exit_failure("getpeername: %s", ERRSTR);
193 /*NOTREACHED*/
194 }
195 if (getnameinfo((struct sockaddr *)&me, melen, NULL, 0,
196 sbuf, sizeof(sbuf), NI_NUMERICHOST) == 0)
197 service = sbuf;
198 else
199 service = DEFAULT_PORT_NAME;
200 if (getnameinfo((struct sockaddr *)&me, melen, NULL, 0,
201 snum, sizeof(snum), NI_NUMERICHOST) != 0)
202 snprintf(snum, sizeof(snum), "?");
203
204 snprintf(logname, sizeof(logname), "faithd %s", snum);
205 snprintf(procname, sizeof(procname), "accepting port %s", snum);
206 openlog(logname, LOG_PID | LOG_NOWAIT, LOG_DAEMON);
207
208 if (argc >= MAXARGV) {
209 exit_failure("too many arguments");
210 /*NOTREACHED*/
211 }
212 serverarg[0] = serverpath = path;
213 for (i = 1; i < argc; i++)
214 serverarg[i] = argv[i];
215 serverarg[i] = NULL;
216
217 error = setsockopt(STDIN_FILENO, SOL_SOCKET, SO_OOBINLINE, &on,
218 sizeof(on));
219 if (error < 0) {
220 exit_failure("setsockopt(SO_OOBINLINE): %s", ERRSTR);
221 /*NOTREACHED*/
222 }
223
224 play_child(STDIN_FILENO, (struct sockaddr *)&from);
225 exit_failure("should not reach here");
226 return 0; /*dummy!*/
227 }
228
229 static int
230 daemon_main(int argc, char **argv)
231 {
232 struct addrinfo hints, *res;
233 int s_wld, error, i, serverargc, on = 1;
234 int family = AF_INET6;
235 int c;
236 #ifdef FAITH_NS
237 char *ns;
238 #endif /* FAITH_NS */
239
240 while ((c = getopt(argc, argv, "df:p46")) != -1) {
241 switch (c) {
242 case 'd':
243 dflag++;
244 break;
245 case 'f':
246 configfile = optarg;
247 break;
248 case 'p':
249 pflag++;
250 break;
251 #ifdef FAITH4
252 case '4':
253 family = AF_INET;
254 break;
255 case '6':
256 family = AF_INET6;
257 break;
258 #endif
259 default:
260 usage();
261 /*NOTREACHED*/
262 }
263 }
264 argc -= optind;
265 argv += optind;
266
267 if (config_load(configfile) < 0 && configfile) {
268 exit_failure("could not load config file");
269 /*NOTREACHED*/
270 }
271
272 #ifdef FAITH_NS
273 if ((ns = getenv(FAITH_NS)) != NULL) {
274 struct sockaddr_storage ss;
275 struct addrinfo hints, *res;
276 char serv[NI_MAXSERV];
277
278 memset(&ss, 0, sizeof(ss));
279 memset(&hints, 0, sizeof(hints));
280 snprintf(serv, sizeof(serv), "%u", NAMESERVER_PORT);
281 hints.ai_flags = AI_NUMERICHOST;
282 if (getaddrinfo(ns, serv, &hints, &res) == 0) {
283 res_init();
284 memcpy(&_res_ext.nsaddr, res->ai_addr, res->ai_addrlen);
285 _res.nscount = 1;
286 }
287 }
288 #endif /* FAITH_NS */
289
290 #ifdef USE_ROUTE
291 grab_myaddrs();
292 #endif
293
294 switch (argc) {
295 case 0:
296 usage();
297 /*NOTREACHED*/
298 default:
299 serverargc = argc - NUMARG;
300 if (serverargc >= MAXARGV)
301 exit_stderr("too many arguments");
302
303 serverpath = malloc(strlen(argv[NUMPRG]) + 1);
304 strcpy(serverpath, argv[NUMPRG]);
305 for (i = 0; i < serverargc; i++) {
306 serverarg[i] = malloc(strlen(argv[i + NUMARG]) + 1);
307 strcpy(serverarg[i], argv[i + NUMARG]);
308 }
309 serverarg[i] = NULL;
310 /* fall throuth */
311 case 1: /* no local service */
312 service = argv[NUMPRT];
313 break;
314 }
315
316 /*
317 * Opening wild card socket for this service.
318 */
319
320 memset(&hints, 0, sizeof(hints));
321 hints.ai_flags = AI_PASSIVE;
322 hints.ai_family = family;
323 hints.ai_socktype = SOCK_STREAM;
324 hints.ai_protocol = 0;
325 error = getaddrinfo(NULL, service, &hints, &res);
326 if (error)
327 exit_stderr("getaddrinfo: %s", gai_strerror(error));
328
329 s_wld = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
330 if (s_wld == -1)
331 exit_stderr("socket: %s", ERRSTR);
332
333 #ifdef IPV6_FAITH
334 if (res->ai_family == AF_INET6) {
335 error = setsockopt(s_wld, IPPROTO_IPV6, IPV6_FAITH, &on, sizeof(on));
336 if (error == -1)
337 exit_stderr("setsockopt(IPV6_FAITH): %s", ERRSTR);
338 }
339 #endif
340 #ifdef FAITH4
341 #ifdef IP_FAITH
342 if (res->ai_family == AF_INET) {
343 error = setsockopt(s_wld, IPPROTO_IP, IP_FAITH, &on, sizeof(on));
344 if (error == -1)
345 exit_stderr("setsockopt(IP_FAITH): %s", ERRSTR);
346 }
347 #endif
348 #endif /* FAITH4 */
349
350 error = setsockopt(s_wld, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
351 if (error == -1)
352 exit_stderr("setsockopt(SO_REUSEADDR): %s", ERRSTR);
353
354 error = setsockopt(s_wld, SOL_SOCKET, SO_OOBINLINE, &on, sizeof(on));
355 if (error == -1)
356 exit_stderr("setsockopt(SO_OOBINLINE): %s", ERRSTR);
357
358 error = bind(s_wld, (struct sockaddr *)res->ai_addr, res->ai_addrlen);
359 if (error == -1)
360 exit_stderr("bind: %s", ERRSTR);
361
362 error = listen(s_wld, 5);
363 if (error == -1)
364 exit_stderr("listen: %s", ERRSTR);
365
366 #ifdef USE_ROUTE
367 sockfd = socket(PF_ROUTE, SOCK_RAW, PF_UNSPEC);
368 if (sockfd < 0) {
369 exit_stderr("socket(PF_ROUTE): %s", ERRSTR);
370 /*NOTREACHED*/
371 }
372 #endif
373
374 /*
375 * Everything is OK.
376 */
377
378 start_daemon();
379
380 snprintf(logname, sizeof(logname), "faithd %s", service);
381 snprintf(procname, sizeof(procname), "accepting port %s", service);
382 openlog(logname, LOG_PID | LOG_NOWAIT, LOG_DAEMON);
383 syslog(LOG_INFO, "Staring faith daemon for %s port", service);
384
385 play_service(s_wld);
386 /* NOTREACHED */
387 exit(1); /*pacify gcc*/
388 }
389
390 static void
391 play_service(int s_wld)
392 {
393 struct sockaddr_storage srcaddr;
394 int len;
395 int s_src;
396 pid_t child_pid;
397 fd_set rfds;
398 int error;
399 int maxfd;
400
401 /*
402 * Wait, accept, fork, faith....
403 */
404 again:
405 setproctitle("%s", procname);
406
407 FD_ZERO(&rfds);
408 FD_SET(s_wld, &rfds);
409 maxfd = s_wld;
410 #ifdef USE_ROUTE
411 if (sockfd) {
412 FD_SET(sockfd, &rfds);
413 maxfd = (maxfd < sockfd) ? sockfd : maxfd;
414 }
415 #endif
416
417 error = select(maxfd + 1, &rfds, NULL, NULL, NULL);
418 if (error < 0) {
419 if (errno == EINTR)
420 goto again;
421 exit_failure("select: %s", ERRSTR);
422 /*NOTREACHED*/
423 }
424
425 #ifdef USE_ROUTE
426 if (FD_ISSET(sockfd, &rfds)) {
427 update_myaddrs();
428 }
429 #endif
430 if (FD_ISSET(s_wld, &rfds)) {
431 len = sizeof(srcaddr);
432 s_src = accept(s_wld, (struct sockaddr *)&srcaddr,
433 &len);
434 if (s_src == -1) {
435 exit_failure("socket: %s", ERRSTR);
436 /*NOTREACHED*/
437 }
438
439 child_pid = fork();
440
441 if (child_pid == 0) {
442 /* child process */
443 close(s_wld);
444 closelog();
445 openlog(logname, LOG_PID | LOG_NOWAIT, LOG_DAEMON);
446 play_child(s_src, (struct sockaddr *)&srcaddr);
447 exit_failure("should never reach here");
448 /*NOTREACHED*/
449 } else {
450 /* parent process */
451 close(s_src);
452 if (child_pid == -1)
453 syslog(LOG_ERR, "can't fork");
454 }
455 }
456 goto again;
457 }
458
459 static void
460 play_child(int s_src, struct sockaddr *srcaddr)
461 {
462 struct sockaddr_storage dstaddr6;
463 struct sockaddr_storage dstaddr4;
464 char src[MAXHOSTNAMELEN];
465 char dst6[MAXHOSTNAMELEN];
466 char dst4[MAXHOSTNAMELEN];
467 int len = sizeof(dstaddr6);
468 int s_dst, error, hport, nresvport, on = 1;
469 struct timeval tv;
470 struct sockaddr *sa4;
471 const struct config *conf;
472
473 tv.tv_sec = 1;
474 tv.tv_usec = 0;
475
476 getnameinfo(srcaddr, srcaddr->sa_len,
477 src, sizeof(src), NULL, 0, NI_NUMERICHOST);
478 syslog(LOG_INFO, "accepted a client from %s", src);
479
480 error = getsockname(s_src, (struct sockaddr *)&dstaddr6, &len);
481 if (error == -1) {
482 exit_failure("getsockname: %s", ERRSTR);
483 /*NOTREACHED*/
484 }
485
486 getnameinfo((struct sockaddr *)&dstaddr6, len,
487 dst6, sizeof(dst6), NULL, 0, NI_NUMERICHOST);
488 syslog(LOG_INFO, "the client is connecting to %s", dst6);
489
490 if (!faith_prefix((struct sockaddr *)&dstaddr6)) {
491 if (serverpath) {
492 /*
493 * Local service
494 */
495 syslog(LOG_INFO, "executing local %s", serverpath);
496 if (!inetd) {
497 dup2(s_src, 0);
498 close(s_src);
499 dup2(0, 1);
500 dup2(0, 2);
501 }
502 execv(serverpath, serverarg);
503 syslog(LOG_ERR, "execv %s: %s", serverpath, ERRSTR);
504 _exit(EXIT_FAILURE);
505 } else {
506 close(s_src);
507 exit_success("no local service for %s", service);
508 }
509 }
510
511 /*
512 * Act as a translator
513 */
514
515 switch (((struct sockaddr *)&dstaddr6)->sa_family) {
516 case AF_INET6:
517 if (!map6to4((struct sockaddr_in6 *)&dstaddr6,
518 (struct sockaddr_in *)&dstaddr4)) {
519 close(s_src);
520 exit_failure("map6to4 failed");
521 /*NOTREACHED*/
522 }
523 syslog(LOG_INFO, "translating from v6 to v4");
524 break;
525 #ifdef FAITH4
526 case AF_INET:
527 if (!map4to6((struct sockaddr_in *)&dstaddr6,
528 (struct sockaddr_in6 *)&dstaddr4)) {
529 close(s_src);
530 exit_failure("map4to6 failed");
531 /*NOTREACHED*/
532 }
533 syslog(LOG_INFO, "translating from v4 to v6");
534 break;
535 #endif
536 default:
537 close(s_src);
538 exit_failure("family not supported");
539 /*NOTREACHED*/
540 }
541
542 sa4 = (struct sockaddr *)&dstaddr4;
543 getnameinfo(sa4, sa4->sa_len,
544 dst4, sizeof(dst4), NULL, 0, NI_NUMERICHOST);
545
546 conf = config_match(srcaddr, sa4);
547 if (!conf || !conf->permit) {
548 close(s_src);
549 exit_failure("translation to %s not permitted for %s", dst4,
550 prefix_string(&conf->match));
551 /*NOTREACHED*/
552 }
553
554 syslog(LOG_INFO, "the translator is connecting to %s", dst4);
555
556 setproctitle("port %s, %s -> %s", service, src, dst4);
557
558 if (sa4->sa_family == AF_INET6)
559 hport = ntohs(((struct sockaddr_in6 *)&dstaddr4)->sin6_port);
560 else /* AF_INET */
561 hport = ntohs(((struct sockaddr_in *)&dstaddr4)->sin_port);
562
563 switch (hport) {
564 case RLOGIN_PORT:
565 case RSH_PORT:
566 s_dst = rresvport_af(&nresvport, sa4->sa_family);
567 break;
568 default:
569 if (pflag)
570 s_dst = rresvport_af(&nresvport, sa4->sa_family);
571 else
572 s_dst = socket(sa4->sa_family, SOCK_STREAM, 0);
573 break;
574 }
575 if (s_dst < 0) {
576 exit_failure("socket: %s", ERRSTR);
577 /*NOTREACHED*/
578 }
579
580 if (conf->src.a.ss_family) {
581 if (bind(s_dst, (struct sockaddr *)&conf->src.a,
582 conf->src.a.ss_len) < 0) {
583 exit_failure("bind: %s", ERRSTR);
584 /*NOTREACHED*/
585 }
586 }
587
588 error = setsockopt(s_dst, SOL_SOCKET, SO_OOBINLINE, &on, sizeof(on));
589 if (error < 0) {
590 exit_failure("setsockopt(SO_OOBINLINE): %s", ERRSTR);
591 /*NOTREACHED*/
592 }
593
594 error = setsockopt(s_src, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(tv));
595 if (error < 0) {
596 exit_failure("setsockopt(SO_SNDTIMEO): %s", ERRSTR);
597 /*NOTREACHED*/
598 }
599 error = setsockopt(s_dst, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(tv));
600 if (error < 0) {
601 exit_failure("setsockopt(SO_SNDTIMEO): %s", ERRSTR);
602 /*NOTREACHED*/
603 }
604
605 error = connect(s_dst, sa4, sa4->sa_len);
606 if (error < 0) {
607 exit_failure("connect: %s", ERRSTR);
608 /*NOTREACHED*/
609 }
610
611 switch (hport) {
612 case FTP_PORT:
613 ftp_relay(s_src, s_dst);
614 break;
615 case RSH_PORT:
616 syslog(LOG_WARNING,
617 "WARINNG: it is insecure to relay rsh port");
618 rsh_relay(s_src, s_dst);
619 break;
620 case RLOGIN_PORT:
621 syslog(LOG_WARNING,
622 "WARINNG: it is insecure to relay rlogin port");
623 /*FALLTHROUGH*/
624 default:
625 tcp_relay(s_src, s_dst, service);
626 break;
627 }
628
629 /* NOTREACHED */
630 }
631
632 /* 0: non faith, 1: faith */
633 static int
634 faith_prefix(struct sockaddr *dst)
635 {
636 #ifndef USE_ROUTE
637 int mib[4], size;
638 struct in6_addr faith_prefix;
639 struct sockaddr_in6 *dst6 = (struct sockaddr_in *)dst;
640
641 if (dst->sa_family != AF_INET6)
642 return 0;
643
644 mib[0] = CTL_NET;
645 mib[1] = PF_INET6;
646 mib[2] = IPPROTO_IPV6;
647 mib[3] = IPV6CTL_FAITH_PREFIX;
648 size = sizeof(struct in6_addr);
649 if (sysctl(mib, 4, &faith_prefix, &size, NULL, 0) < 0) {
650 exit_failure("sysctl: %s", ERRSTR);
651 /*NOTREACHED*/
652 }
653
654 if (memcmp(dst, &faith_prefix,
655 sizeof(struct in6_addr) - sizeof(struct in_addr) == 0) {
656 return 1;
657 }
658 return 0;
659 #else
660 struct myaddrs *p;
661 struct sockaddr_in6 *sin6;
662 struct sockaddr_in *sin4;
663 struct sockaddr_in6 *dst6;
664 struct sockaddr_in *dst4;
665 struct sockaddr_in dstmap;
666
667 dst6 = (struct sockaddr_in6 *)dst;
668 if (dst->sa_family == AF_INET6
669 && IN6_IS_ADDR_V4MAPPED(&dst6->sin6_addr)) {
670 /* ugly... */
671 memset(&dstmap, 0, sizeof(dstmap));
672 dstmap.sin_family = AF_INET;
673 dstmap.sin_len = sizeof(dstmap);
674 memcpy(&dstmap.sin_addr, &dst6->sin6_addr.s6_addr[12],
675 sizeof(dstmap.sin_addr));
676 dst = (struct sockaddr *)&dstmap;
677 }
678
679 dst6 = (struct sockaddr_in6 *)dst;
680 dst4 = (struct sockaddr_in *)dst;
681
682 for (p = myaddrs; p; p = p->next) {
683 sin6 = (struct sockaddr_in6 *)p->addr;
684 sin4 = (struct sockaddr_in *)p->addr;
685
686 if (p->addr->sa_len != dst->sa_len
687 || p->addr->sa_family != dst->sa_family)
688 continue;
689
690 switch (dst->sa_family) {
691 case AF_INET6:
692 if (sin6->sin6_scope_id == dst6->sin6_scope_id
693 && IN6_ARE_ADDR_EQUAL(&sin6->sin6_addr, &dst6->sin6_addr))
694 return 0;
695 break;
696 case AF_INET:
697 if (sin4->sin_addr.s_addr == dst4->sin_addr.s_addr)
698 return 0;
699 break;
700 }
701 }
702 return 1;
703 #endif
704 }
705
706 /* 0: non faith, 1: faith */
707 static int
708 map6to4(struct sockaddr_in6 *dst6, struct sockaddr_in *dst4)
709 {
710 memset(dst4, 0, sizeof(*dst4));
711 dst4->sin_len = sizeof(*dst4);
712 dst4->sin_family = AF_INET;
713 dst4->sin_port = dst6->sin6_port;
714 memcpy(&dst4->sin_addr, &dst6->sin6_addr.s6_addr[12],
715 sizeof(dst4->sin_addr));
716
717 if (dst4->sin_addr.s_addr == INADDR_ANY
718 || dst4->sin_addr.s_addr == INADDR_BROADCAST
719 || IN_MULTICAST(ntohl(dst4->sin_addr.s_addr)))
720 return 0;
721
722 return 1;
723 }
724
725 #ifdef FAITH4
726 /* 0: non faith, 1: faith */
727 static int
728 map4to6(struct sockaddr_in *dst4, struct sockaddr_in6 *dst6)
729 {
730 char host[NI_MAXHOST];
731 char serv[NI_MAXSERV];
732 struct addrinfo hints, *res;
733 int ai_errno;
734
735 if (getnameinfo((struct sockaddr *)dst4, dst4->sin_len, host, sizeof(host),
736 serv, sizeof(serv), NI_NAMEREQD|NI_NUMERICSERV) != 0)
737 return 0;
738
739 memset(&hints, 0, sizeof(hints));
740 hints.ai_flags = 0;
741 hints.ai_family = AF_INET6;
742 hints.ai_socktype = SOCK_STREAM;
743 hints.ai_protocol = 0;
744
745 if ((ai_errno = getaddrinfo(host, serv, &hints, &res)) != 0) {
746 syslog(LOG_INFO, "%s %s: %s", host, serv, gai_strerror(ai_errno));
747 return 0;
748 }
749
750 memcpy(dst6, res->ai_addr, res->ai_addrlen);
751
752 freeaddrinfo(res);
753
754 return 1;
755 }
756 #endif /* FAITH4 */
757
758 static void
759 sig_child(int sig)
760 {
761 int status;
762 pid_t pid;
763
764 pid = wait3(&status, WNOHANG, (struct rusage *)0);
765 if (pid && WEXITSTATUS(status))
766 syslog(LOG_WARNING, "child %d exit status 0x%x", pid, status);
767 }
768
769 void
770 sig_terminate(int sig)
771 {
772 syslog(LOG_INFO, "Terminating faith daemon");
773 exit(EXIT_SUCCESS);
774 }
775
776 static void
777 start_daemon(void)
778 {
779 #ifdef SA_NOCLDWAIT
780 struct sigaction sa;
781 #endif
782
783 if (daemon(0, 0) == -1)
784 exit_stderr("daemon: %s", ERRSTR);
785
786 #ifdef SA_NOCLDWAIT
787 memset(&sa, 0, sizeof(sa));
788 sa.sa_handler = sig_child;
789 sa.sa_flags = SA_NOCLDWAIT;
790 sigemptyset(&sa.sa_mask);
791 sigaction(SIGCHLD, &sa, (struct sigaction *)0);
792 #else
793 if (signal(SIGCHLD, sig_child) == SIG_ERR) {
794 exit_failure("signal CHLD: %s", ERRSTR);
795 /*NOTREACHED*/
796 }
797 #endif
798
799 if (signal(SIGTERM, sig_terminate) == SIG_ERR) {
800 exit_failure("signal TERM: %s", ERRSTR);
801 /*NOTREACHED*/
802 }
803 }
804
805 static void
806 exit_stderr(const char *fmt, ...)
807 {
808 va_list ap;
809 char buf[BUFSIZ];
810
811 va_start(ap, fmt);
812 vsnprintf(buf, sizeof(buf), fmt, ap);
813 va_end(ap);
814 fprintf(stderr, "%s\n", buf);
815 exit(EXIT_FAILURE);
816 }
817
818 void
819 exit_failure(const char *fmt, ...)
820 {
821 va_list ap;
822 char buf[BUFSIZ];
823
824 va_start(ap, fmt);
825 vsnprintf(buf, sizeof(buf), fmt, ap);
826 va_end(ap);
827 syslog(LOG_ERR, "%s", buf);
828 exit(EXIT_FAILURE);
829 }
830
831 void
832 exit_success(const char *fmt, ...)
833 {
834 va_list ap;
835 char buf[BUFSIZ];
836
837 va_start(ap, fmt);
838 vsnprintf(buf, sizeof(buf), fmt, ap);
839 va_end(ap);
840 syslog(LOG_INFO, "%s", buf);
841 exit(EXIT_SUCCESS);
842 }
843
844 #ifdef USE_ROUTE
845 #ifndef HAVE_GETIFADDRS
846 static unsigned int
847 if_maxindex()
848 {
849 struct if_nameindex *p, *p0;
850 unsigned int max = 0;
851
852 p0 = if_nameindex();
853 for (p = p0; p && p->if_index && p->if_name; p++) {
854 if (max < p->if_index)
855 max = p->if_index;
856 }
857 if_freenameindex(p0);
858 return max;
859 }
860 #endif
861
862 static void
863 grab_myaddrs()
864 {
865 #ifdef HAVE_GETIFADDRS
866 struct ifaddrs *ifap, *ifa;
867 struct myaddrs *p;
868 struct sockaddr_in6 *sin6;
869
870 if (getifaddrs(&ifap) != 0) {
871 exit_failure("getifaddrs");
872 /*NOTREACHED*/
873 }
874
875 for (ifa = ifap; ifa; ifa = ifa->ifa_next) {
876 switch (ifa->ifa_addr->sa_family) {
877 case AF_INET:
878 case AF_INET6:
879 break;
880 default:
881 continue;
882 }
883
884 p = (struct myaddrs *)malloc(sizeof(struct myaddrs) +
885 ifa->ifa_addr->sa_len);
886 if (!p) {
887 exit_failure("not enough core");
888 /*NOTREACHED*/
889 }
890 memcpy(p + 1, ifa->ifa_addr, ifa->ifa_addr->sa_len);
891 p->next = myaddrs;
892 p->addr = (struct sockaddr *)(p + 1);
893 #ifdef __KAME__
894 if (ifa->ifa_addr->sa_family == AF_INET6) {
895 sin6 = (struct sockaddr_in6 *)p->addr;
896 if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)
897 || IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) {
898 sin6->sin6_scope_id =
899 ntohs(*(u_int16_t *)&sin6->sin6_addr.s6_addr[2]);
900 sin6->sin6_addr.s6_addr[2] = 0;
901 sin6->sin6_addr.s6_addr[3] = 0;
902 }
903 }
904 #endif
905 myaddrs = p;
906 if (dflag) {
907 char hbuf[NI_MAXHOST];
908 getnameinfo(p->addr, p->addr->sa_len,
909 hbuf, sizeof(hbuf), NULL, 0,
910 NI_NUMERICHOST);
911 syslog(LOG_INFO, "my interface: %s %s", hbuf,
912 ifa->ifa_name);
913 }
914 }
915
916 freeifaddrs(ifap);
917 #else
918 int s;
919 unsigned int maxif;
920 struct ifreq *iflist;
921 struct ifconf ifconf;
922 struct ifreq *ifr, *ifrp, *ifr_end;
923 struct myaddrs *p;
924 struct sockaddr_in6 *sin6;
925 size_t siz;
926 char ifrbuf[sizeof(struct ifreq) + 1024];
927
928 maxif = if_maxindex() + 1;
929 iflist = (struct ifreq *)malloc(maxif * BUFSIZ); /* XXX */
930 if (!iflist) {
931 exit_failure("not enough core");
932 /*NOTREACHED*/
933 }
934
935 if ((s = socket(PF_INET, SOCK_DGRAM, 0)) < 0) {
936 exit_failure("socket(SOCK_DGRAM)");
937 /*NOTREACHED*/
938 }
939 memset(&ifconf, 0, sizeof(ifconf));
940 ifconf.ifc_req = iflist;
941 ifconf.ifc_len = maxif * BUFSIZ; /* XXX */
942 if (ioctl(s, SIOCGIFCONF, &ifconf) < 0) {
943 exit_failure("ioctl(SIOCGIFCONF)");
944 /*NOTREACHED*/
945 }
946 close(s);
947
948 /* Look for this interface in the list */
949 ifr_end = (struct ifreq *) (ifconf.ifc_buf + ifconf.ifc_len);
950 for (ifrp = ifconf.ifc_req;
951 ifrp < ifr_end;
952 ifrp = (struct ifreq *)((char *)ifrp + siz)) {
953 memcpy(ifrbuf, ifrp, sizeof(*ifrp));
954 ifr = (struct ifreq *)ifrbuf;
955 siz = ifr->ifr_addr.sa_len;
956 if (siz < sizeof(ifr->ifr_addr))
957 siz = sizeof(ifr->ifr_addr);
958 siz += (sizeof(*ifrp) - sizeof(ifr->ifr_addr));
959 if (siz > sizeof(ifrbuf)) {
960 /* ifr too big */
961 break;
962 }
963 memcpy(ifrbuf, ifrp, siz);
964
965 switch (ifr->ifr_addr.sa_family) {
966 case AF_INET:
967 case AF_INET6:
968 p = (struct myaddrs *)malloc(sizeof(struct myaddrs)
969 + ifr->ifr_addr.sa_len);
970 if (!p) {
971 exit_failure("not enough core");
972 /*NOTREACHED*/
973 }
974 memcpy(p + 1, &ifr->ifr_addr, ifr->ifr_addr.sa_len);
975 p->next = myaddrs;
976 p->addr = (struct sockaddr *)(p + 1);
977 #ifdef __KAME__
978 if (ifr->ifr_addr.sa_family == AF_INET6) {
979 sin6 = (struct sockaddr_in6 *)p->addr;
980 if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr)
981 || IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) {
982 sin6->sin6_scope_id =
983 ntohs(*(u_int16_t *)&sin6->sin6_addr.s6_addr[2]);
984 sin6->sin6_addr.s6_addr[2] = 0;
985 sin6->sin6_addr.s6_addr[3] = 0;
986 }
987 }
988 #endif
989 myaddrs = p;
990 if (dflag) {
991 char hbuf[NI_MAXHOST];
992 getnameinfo(p->addr, p->addr->sa_len,
993 hbuf, sizeof(hbuf), NULL, 0,
994 NI_NUMERICHOST);
995 syslog(LOG_INFO, "my interface: %s %s", hbuf, ifr->ifr_name);
996 }
997 break;
998 default:
999 break;
1000 }
1001 }
1002
1003 free(iflist);
1004 #endif
1005 }
1006
1007 static void
1008 free_myaddrs()
1009 {
1010 struct myaddrs *p, *q;
1011
1012 p = myaddrs;
1013 while (p) {
1014 q = p->next;
1015 free(p);
1016 p = q;
1017 }
1018 myaddrs = NULL;
1019 }
1020
1021 static void
1022 update_myaddrs()
1023 {
1024 char msg[BUFSIZ];
1025 int len;
1026 struct rt_msghdr *rtm;
1027
1028 len = read(sockfd, msg, sizeof(msg));
1029 if (len < 0) {
1030 syslog(LOG_ERR, "read(PF_ROUTE) failed");
1031 return;
1032 }
1033 rtm = (struct rt_msghdr *)msg;
1034 if (len < 4 || len < rtm->rtm_msglen) {
1035 syslog(LOG_ERR, "read(PF_ROUTE) short read");
1036 return;
1037 }
1038 if (rtm->rtm_version != RTM_VERSION) {
1039 syslog(LOG_ERR, "routing socket version mismatch");
1040 close(sockfd);
1041 sockfd = 0;
1042 return;
1043 }
1044 switch (rtm->rtm_type) {
1045 case RTM_NEWADDR:
1046 case RTM_DELADDR:
1047 case RTM_IFINFO:
1048 break;
1049 default:
1050 return;
1051 }
1052 /* XXX more filters here? */
1053
1054 syslog(LOG_INFO, "update interface address list");
1055 free_myaddrs();
1056 grab_myaddrs();
1057 }
1058 #endif /*USE_ROUTE*/
1059
1060 static void
1061 usage()
1062 {
1063 fprintf(stderr, "usage: %s [-dp] [-f conf] service [serverpath [serverargs]]\n",
1064 faithdname);
1065 exit(0);
1066 }
1067