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