Home | History | Annotate | Line # | Download | only in faithd
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