faithd.c revision 1.17
1 /* $NetBSD: faithd.c,v 1.17 2001/02/15 17:58:55 itojun Exp $ */ 2 /* $KAME: faithd.c,v 1.35 2001/02/10 05:24: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 if (daemon(0, 0) == -1) 780 exit_stderr("daemon: %s", ERRSTR); 781 782 if (signal(SIGCHLD, sig_child) == SIG_ERR) { 783 exit_failure("signal CHLD: %s", ERRSTR); 784 /*NOTREACHED*/ 785 } 786 787 if (signal(SIGTERM, sig_terminate) == SIG_ERR) { 788 exit_failure("signal TERM: %s", ERRSTR); 789 /*NOTREACHED*/ 790 } 791 } 792 793 static void 794 exit_stderr(const char *fmt, ...) 795 { 796 va_list ap; 797 char buf[BUFSIZ]; 798 799 va_start(ap, fmt); 800 vsnprintf(buf, sizeof(buf), fmt, ap); 801 va_end(ap); 802 fprintf(stderr, "%s\n", buf); 803 exit(EXIT_FAILURE); 804 } 805 806 void 807 exit_failure(const char *fmt, ...) 808 { 809 va_list ap; 810 char buf[BUFSIZ]; 811 812 va_start(ap, fmt); 813 vsnprintf(buf, sizeof(buf), fmt, ap); 814 va_end(ap); 815 syslog(LOG_ERR, "%s", buf); 816 exit(EXIT_FAILURE); 817 } 818 819 void 820 exit_success(const char *fmt, ...) 821 { 822 va_list ap; 823 char buf[BUFSIZ]; 824 825 va_start(ap, fmt); 826 vsnprintf(buf, sizeof(buf), fmt, ap); 827 va_end(ap); 828 syslog(LOG_INFO, "%s", buf); 829 exit(EXIT_SUCCESS); 830 } 831 832 #ifdef USE_ROUTE 833 #ifndef HAVE_GETIFADDRS 834 static unsigned int 835 if_maxindex() 836 { 837 struct if_nameindex *p, *p0; 838 unsigned int max = 0; 839 840 p0 = if_nameindex(); 841 for (p = p0; p && p->if_index && p->if_name; p++) { 842 if (max < p->if_index) 843 max = p->if_index; 844 } 845 if_freenameindex(p0); 846 return max; 847 } 848 #endif 849 850 static void 851 grab_myaddrs() 852 { 853 #ifdef HAVE_GETIFADDRS 854 struct ifaddrs *ifap, *ifa; 855 struct myaddrs *p; 856 struct sockaddr_in6 *sin6; 857 858 if (getifaddrs(&ifap) != 0) { 859 exit_failure("getifaddrs"); 860 /*NOTREACHED*/ 861 } 862 863 for (ifa = ifap; ifa; ifa = ifa->ifa_next) { 864 switch (ifa->ifa_addr->sa_family) { 865 case AF_INET: 866 case AF_INET6: 867 break; 868 default: 869 continue; 870 } 871 872 p = (struct myaddrs *)malloc(sizeof(struct myaddrs) + 873 ifa->ifa_addr->sa_len); 874 if (!p) { 875 exit_failure("not enough core"); 876 /*NOTREACHED*/ 877 } 878 memcpy(p + 1, ifa->ifa_addr, ifa->ifa_addr->sa_len); 879 p->next = myaddrs; 880 p->addr = (struct sockaddr *)(p + 1); 881 #ifdef __KAME__ 882 if (ifa->ifa_addr->sa_family == AF_INET6) { 883 sin6 = (struct sockaddr_in6 *)p->addr; 884 if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr) 885 || IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) { 886 sin6->sin6_scope_id = 887 ntohs(*(u_int16_t *)&sin6->sin6_addr.s6_addr[2]); 888 sin6->sin6_addr.s6_addr[2] = 0; 889 sin6->sin6_addr.s6_addr[3] = 0; 890 } 891 } 892 #endif 893 myaddrs = p; 894 if (dflag) { 895 char hbuf[NI_MAXHOST]; 896 getnameinfo(p->addr, p->addr->sa_len, 897 hbuf, sizeof(hbuf), NULL, 0, 898 NI_NUMERICHOST); 899 syslog(LOG_INFO, "my interface: %s %s", hbuf, 900 ifa->ifa_name); 901 } 902 } 903 904 freeifaddrs(ifap); 905 #else 906 int s; 907 unsigned int maxif; 908 struct ifreq *iflist; 909 struct ifconf ifconf; 910 struct ifreq *ifr, *ifrp, *ifr_end; 911 struct myaddrs *p; 912 struct sockaddr_in6 *sin6; 913 size_t siz; 914 char ifrbuf[sizeof(struct ifreq) + 1024]; 915 916 maxif = if_maxindex() + 1; 917 iflist = (struct ifreq *)malloc(maxif * BUFSIZ); /* XXX */ 918 if (!iflist) { 919 exit_failure("not enough core"); 920 /*NOTREACHED*/ 921 } 922 923 if ((s = socket(PF_INET, SOCK_DGRAM, 0)) < 0) { 924 exit_failure("socket(SOCK_DGRAM)"); 925 /*NOTREACHED*/ 926 } 927 memset(&ifconf, 0, sizeof(ifconf)); 928 ifconf.ifc_req = iflist; 929 ifconf.ifc_len = maxif * BUFSIZ; /* XXX */ 930 if (ioctl(s, SIOCGIFCONF, &ifconf) < 0) { 931 exit_failure("ioctl(SIOCGIFCONF)"); 932 /*NOTREACHED*/ 933 } 934 close(s); 935 936 /* Look for this interface in the list */ 937 ifr_end = (struct ifreq *) (ifconf.ifc_buf + ifconf.ifc_len); 938 for (ifrp = ifconf.ifc_req; 939 ifrp < ifr_end; 940 ifrp = (struct ifreq *)((char *)ifrp + siz)) { 941 memcpy(ifrbuf, ifrp, sizeof(*ifrp)); 942 ifr = (struct ifreq *)ifrbuf; 943 siz = ifr->ifr_addr.sa_len; 944 if (siz < sizeof(ifr->ifr_addr)) 945 siz = sizeof(ifr->ifr_addr); 946 siz += (sizeof(*ifrp) - sizeof(ifr->ifr_addr)); 947 if (siz > sizeof(ifrbuf)) { 948 /* ifr too big */ 949 break; 950 } 951 memcpy(ifrbuf, ifrp, siz); 952 953 switch (ifr->ifr_addr.sa_family) { 954 case AF_INET: 955 case AF_INET6: 956 p = (struct myaddrs *)malloc(sizeof(struct myaddrs) 957 + ifr->ifr_addr.sa_len); 958 if (!p) { 959 exit_failure("not enough core"); 960 /*NOTREACHED*/ 961 } 962 memcpy(p + 1, &ifr->ifr_addr, ifr->ifr_addr.sa_len); 963 p->next = myaddrs; 964 p->addr = (struct sockaddr *)(p + 1); 965 #ifdef __KAME__ 966 if (ifr->ifr_addr.sa_family == AF_INET6) { 967 sin6 = (struct sockaddr_in6 *)p->addr; 968 if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr) 969 || IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) { 970 sin6->sin6_scope_id = 971 ntohs(*(u_int16_t *)&sin6->sin6_addr.s6_addr[2]); 972 sin6->sin6_addr.s6_addr[2] = 0; 973 sin6->sin6_addr.s6_addr[3] = 0; 974 } 975 } 976 #endif 977 myaddrs = p; 978 if (dflag) { 979 char hbuf[NI_MAXHOST]; 980 getnameinfo(p->addr, p->addr->sa_len, 981 hbuf, sizeof(hbuf), NULL, 0, 982 NI_NUMERICHOST); 983 syslog(LOG_INFO, "my interface: %s %s", hbuf, ifr->ifr_name); 984 } 985 break; 986 default: 987 break; 988 } 989 } 990 991 free(iflist); 992 #endif 993 } 994 995 static void 996 free_myaddrs() 997 { 998 struct myaddrs *p, *q; 999 1000 p = myaddrs; 1001 while (p) { 1002 q = p->next; 1003 free(p); 1004 p = q; 1005 } 1006 myaddrs = NULL; 1007 } 1008 1009 static void 1010 update_myaddrs() 1011 { 1012 char msg[BUFSIZ]; 1013 int len; 1014 struct rt_msghdr *rtm; 1015 1016 len = read(sockfd, msg, sizeof(msg)); 1017 if (len < 0) { 1018 syslog(LOG_ERR, "read(PF_ROUTE) failed"); 1019 return; 1020 } 1021 rtm = (struct rt_msghdr *)msg; 1022 if (len < 4 || len < rtm->rtm_msglen) { 1023 syslog(LOG_ERR, "read(PF_ROUTE) short read"); 1024 return; 1025 } 1026 if (rtm->rtm_version != RTM_VERSION) { 1027 syslog(LOG_ERR, "routing socket version mismatch"); 1028 close(sockfd); 1029 sockfd = 0; 1030 return; 1031 } 1032 switch (rtm->rtm_type) { 1033 case RTM_NEWADDR: 1034 case RTM_DELADDR: 1035 case RTM_IFINFO: 1036 break; 1037 default: 1038 return; 1039 } 1040 /* XXX more filters here? */ 1041 1042 syslog(LOG_INFO, "update interface address list"); 1043 free_myaddrs(); 1044 grab_myaddrs(); 1045 } 1046 #endif /*USE_ROUTE*/ 1047 1048 static void 1049 usage() 1050 { 1051 fprintf(stderr, "usage: %s [-dp] [-f conf] service [serverpath [serverargs]]\n", 1052 faithdname); 1053 exit(0); 1054 } 1055
Indexes created Sat Oct 25 01:09:55 GMT 2025