faithd.c revision 1.19
1 /* $NetBSD: faithd.c,v 1.19 2001/04/25 11:25:51 itojun Exp $ */ 2 /* $KAME: faithd.c,v 1.39 2001/04/25 11:20:42 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 if (conf) { 550 exit_failure("translation to %s not permitted for %s", 551 dst4, prefix_string(&conf->match)); 552 /*NOTREACHED*/ 553 } else { 554 exit_failure("translation to %s not permitted", dst4); 555 /*NOTREACHED*/ 556 } 557 } 558 559 syslog(LOG_INFO, "the translator is connecting to %s", dst4); 560 561 setproctitle("port %s, %s -> %s", service, src, dst4); 562 563 if (sa4->sa_family == AF_INET6) 564 hport = ntohs(((struct sockaddr_in6 *)&dstaddr4)->sin6_port); 565 else /* AF_INET */ 566 hport = ntohs(((struct sockaddr_in *)&dstaddr4)->sin_port); 567 568 switch (hport) { 569 case RLOGIN_PORT: 570 case RSH_PORT: 571 s_dst = rresvport_af(&nresvport, sa4->sa_family); 572 break; 573 default: 574 if (pflag) 575 s_dst = rresvport_af(&nresvport, sa4->sa_family); 576 else 577 s_dst = socket(sa4->sa_family, SOCK_STREAM, 0); 578 break; 579 } 580 if (s_dst < 0) { 581 exit_failure("socket: %s", ERRSTR); 582 /*NOTREACHED*/ 583 } 584 585 if (conf->src.a.ss_family) { 586 if (bind(s_dst, (struct sockaddr *)&conf->src.a, 587 conf->src.a.ss_len) < 0) { 588 exit_failure("bind: %s", ERRSTR); 589 /*NOTREACHED*/ 590 } 591 } 592 593 error = setsockopt(s_dst, SOL_SOCKET, SO_OOBINLINE, &on, sizeof(on)); 594 if (error < 0) { 595 exit_failure("setsockopt(SO_OOBINLINE): %s", ERRSTR); 596 /*NOTREACHED*/ 597 } 598 599 error = setsockopt(s_src, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(tv)); 600 if (error < 0) { 601 exit_failure("setsockopt(SO_SNDTIMEO): %s", ERRSTR); 602 /*NOTREACHED*/ 603 } 604 error = setsockopt(s_dst, SOL_SOCKET, SO_SNDTIMEO, &tv, sizeof(tv)); 605 if (error < 0) { 606 exit_failure("setsockopt(SO_SNDTIMEO): %s", ERRSTR); 607 /*NOTREACHED*/ 608 } 609 610 error = connect(s_dst, sa4, sa4->sa_len); 611 if (error < 0) { 612 exit_failure("connect: %s", ERRSTR); 613 /*NOTREACHED*/ 614 } 615 616 switch (hport) { 617 case FTP_PORT: 618 ftp_relay(s_src, s_dst); 619 break; 620 case RSH_PORT: 621 syslog(LOG_WARNING, 622 "WARINNG: it is insecure to relay rsh port"); 623 rsh_relay(s_src, s_dst); 624 break; 625 case RLOGIN_PORT: 626 syslog(LOG_WARNING, 627 "WARINNG: it is insecure to relay rlogin port"); 628 /*FALLTHROUGH*/ 629 default: 630 tcp_relay(s_src, s_dst, service); 631 break; 632 } 633 634 /* NOTREACHED */ 635 } 636 637 /* 0: non faith, 1: faith */ 638 static int 639 faith_prefix(struct sockaddr *dst) 640 { 641 #ifndef USE_ROUTE 642 int mib[4], size; 643 struct in6_addr faith_prefix; 644 struct sockaddr_in6 *dst6 = (struct sockaddr_in *)dst; 645 646 if (dst->sa_family != AF_INET6) 647 return 0; 648 649 mib[0] = CTL_NET; 650 mib[1] = PF_INET6; 651 mib[2] = IPPROTO_IPV6; 652 mib[3] = IPV6CTL_FAITH_PREFIX; 653 size = sizeof(struct in6_addr); 654 if (sysctl(mib, 4, &faith_prefix, &size, NULL, 0) < 0) { 655 exit_failure("sysctl: %s", ERRSTR); 656 /*NOTREACHED*/ 657 } 658 659 if (memcmp(dst, &faith_prefix, 660 sizeof(struct in6_addr) - sizeof(struct in_addr) == 0) { 661 return 1; 662 } 663 return 0; 664 #else 665 struct myaddrs *p; 666 struct sockaddr_in6 *sin6; 667 struct sockaddr_in *sin4; 668 struct sockaddr_in6 *dst6; 669 struct sockaddr_in *dst4; 670 struct sockaddr_in dstmap; 671 672 dst6 = (struct sockaddr_in6 *)dst; 673 if (dst->sa_family == AF_INET6 674 && IN6_IS_ADDR_V4MAPPED(&dst6->sin6_addr)) { 675 /* ugly... */ 676 memset(&dstmap, 0, sizeof(dstmap)); 677 dstmap.sin_family = AF_INET; 678 dstmap.sin_len = sizeof(dstmap); 679 memcpy(&dstmap.sin_addr, &dst6->sin6_addr.s6_addr[12], 680 sizeof(dstmap.sin_addr)); 681 dst = (struct sockaddr *)&dstmap; 682 } 683 684 dst6 = (struct sockaddr_in6 *)dst; 685 dst4 = (struct sockaddr_in *)dst; 686 687 for (p = myaddrs; p; p = p->next) { 688 sin6 = (struct sockaddr_in6 *)p->addr; 689 sin4 = (struct sockaddr_in *)p->addr; 690 691 if (p->addr->sa_len != dst->sa_len 692 || p->addr->sa_family != dst->sa_family) 693 continue; 694 695 switch (dst->sa_family) { 696 case AF_INET6: 697 if (sin6->sin6_scope_id == dst6->sin6_scope_id 698 && IN6_ARE_ADDR_EQUAL(&sin6->sin6_addr, &dst6->sin6_addr)) 699 return 0; 700 break; 701 case AF_INET: 702 if (sin4->sin_addr.s_addr == dst4->sin_addr.s_addr) 703 return 0; 704 break; 705 } 706 } 707 return 1; 708 #endif 709 } 710 711 /* 0: non faith, 1: faith */ 712 static int 713 map6to4(struct sockaddr_in6 *dst6, struct sockaddr_in *dst4) 714 { 715 memset(dst4, 0, sizeof(*dst4)); 716 dst4->sin_len = sizeof(*dst4); 717 dst4->sin_family = AF_INET; 718 dst4->sin_port = dst6->sin6_port; 719 memcpy(&dst4->sin_addr, &dst6->sin6_addr.s6_addr[12], 720 sizeof(dst4->sin_addr)); 721 722 if (dst4->sin_addr.s_addr == INADDR_ANY 723 || dst4->sin_addr.s_addr == INADDR_BROADCAST 724 || IN_MULTICAST(ntohl(dst4->sin_addr.s_addr))) 725 return 0; 726 727 return 1; 728 } 729 730 #ifdef FAITH4 731 /* 0: non faith, 1: faith */ 732 static int 733 map4to6(struct sockaddr_in *dst4, struct sockaddr_in6 *dst6) 734 { 735 char host[NI_MAXHOST]; 736 char serv[NI_MAXSERV]; 737 struct addrinfo hints, *res; 738 int ai_errno; 739 740 if (getnameinfo((struct sockaddr *)dst4, dst4->sin_len, host, sizeof(host), 741 serv, sizeof(serv), NI_NAMEREQD|NI_NUMERICSERV) != 0) 742 return 0; 743 744 memset(&hints, 0, sizeof(hints)); 745 hints.ai_flags = 0; 746 hints.ai_family = AF_INET6; 747 hints.ai_socktype = SOCK_STREAM; 748 hints.ai_protocol = 0; 749 750 if ((ai_errno = getaddrinfo(host, serv, &hints, &res)) != 0) { 751 syslog(LOG_INFO, "%s %s: %s", host, serv, gai_strerror(ai_errno)); 752 return 0; 753 } 754 755 memcpy(dst6, res->ai_addr, res->ai_addrlen); 756 757 freeaddrinfo(res); 758 759 return 1; 760 } 761 #endif /* FAITH4 */ 762 763 static void 764 sig_child(int sig) 765 { 766 int status; 767 pid_t pid; 768 769 pid = wait3(&status, WNOHANG, (struct rusage *)0); 770 if (pid && WEXITSTATUS(status)) 771 syslog(LOG_WARNING, "child %d exit status 0x%x", pid, status); 772 } 773 774 void 775 sig_terminate(int sig) 776 { 777 syslog(LOG_INFO, "Terminating faith daemon"); 778 exit(EXIT_SUCCESS); 779 } 780 781 static void 782 start_daemon(void) 783 { 784 #ifdef SA_NOCLDWAIT 785 struct sigaction sa; 786 #endif 787 788 if (daemon(0, 0) == -1) 789 exit_stderr("daemon: %s", ERRSTR); 790 791 #ifdef SA_NOCLDWAIT 792 memset(&sa, 0, sizeof(sa)); 793 sa.sa_handler = sig_child; 794 sa.sa_flags = SA_NOCLDWAIT; 795 sigemptyset(&sa.sa_mask); 796 sigaction(SIGCHLD, &sa, (struct sigaction *)0); 797 #else 798 if (signal(SIGCHLD, sig_child) == SIG_ERR) { 799 exit_failure("signal CHLD: %s", ERRSTR); 800 /*NOTREACHED*/ 801 } 802 #endif 803 804 if (signal(SIGTERM, sig_terminate) == SIG_ERR) { 805 exit_failure("signal TERM: %s", ERRSTR); 806 /*NOTREACHED*/ 807 } 808 } 809 810 static void 811 exit_stderr(const char *fmt, ...) 812 { 813 va_list ap; 814 char buf[BUFSIZ]; 815 816 va_start(ap, fmt); 817 vsnprintf(buf, sizeof(buf), fmt, ap); 818 va_end(ap); 819 fprintf(stderr, "%s\n", buf); 820 exit(EXIT_FAILURE); 821 } 822 823 void 824 exit_failure(const char *fmt, ...) 825 { 826 va_list ap; 827 char buf[BUFSIZ]; 828 829 va_start(ap, fmt); 830 vsnprintf(buf, sizeof(buf), fmt, ap); 831 va_end(ap); 832 syslog(LOG_ERR, "%s", buf); 833 exit(EXIT_FAILURE); 834 } 835 836 void 837 exit_success(const char *fmt, ...) 838 { 839 va_list ap; 840 char buf[BUFSIZ]; 841 842 va_start(ap, fmt); 843 vsnprintf(buf, sizeof(buf), fmt, ap); 844 va_end(ap); 845 syslog(LOG_INFO, "%s", buf); 846 exit(EXIT_SUCCESS); 847 } 848 849 #ifdef USE_ROUTE 850 #ifndef HAVE_GETIFADDRS 851 static unsigned int 852 if_maxindex() 853 { 854 struct if_nameindex *p, *p0; 855 unsigned int max = 0; 856 857 p0 = if_nameindex(); 858 for (p = p0; p && p->if_index && p->if_name; p++) { 859 if (max < p->if_index) 860 max = p->if_index; 861 } 862 if_freenameindex(p0); 863 return max; 864 } 865 #endif 866 867 static void 868 grab_myaddrs() 869 { 870 #ifdef HAVE_GETIFADDRS 871 struct ifaddrs *ifap, *ifa; 872 struct myaddrs *p; 873 struct sockaddr_in6 *sin6; 874 875 if (getifaddrs(&ifap) != 0) { 876 exit_failure("getifaddrs"); 877 /*NOTREACHED*/ 878 } 879 880 for (ifa = ifap; ifa; ifa = ifa->ifa_next) { 881 switch (ifa->ifa_addr->sa_family) { 882 case AF_INET: 883 case AF_INET6: 884 break; 885 default: 886 continue; 887 } 888 889 p = (struct myaddrs *)malloc(sizeof(struct myaddrs) + 890 ifa->ifa_addr->sa_len); 891 if (!p) { 892 exit_failure("not enough core"); 893 /*NOTREACHED*/ 894 } 895 memcpy(p + 1, ifa->ifa_addr, ifa->ifa_addr->sa_len); 896 p->next = myaddrs; 897 p->addr = (struct sockaddr *)(p + 1); 898 #ifdef __KAME__ 899 if (ifa->ifa_addr->sa_family == AF_INET6) { 900 sin6 = (struct sockaddr_in6 *)p->addr; 901 if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr) 902 || IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) { 903 sin6->sin6_scope_id = 904 ntohs(*(u_int16_t *)&sin6->sin6_addr.s6_addr[2]); 905 sin6->sin6_addr.s6_addr[2] = 0; 906 sin6->sin6_addr.s6_addr[3] = 0; 907 } 908 } 909 #endif 910 myaddrs = p; 911 if (dflag) { 912 char hbuf[NI_MAXHOST]; 913 getnameinfo(p->addr, p->addr->sa_len, 914 hbuf, sizeof(hbuf), NULL, 0, 915 NI_NUMERICHOST); 916 syslog(LOG_INFO, "my interface: %s %s", hbuf, 917 ifa->ifa_name); 918 } 919 } 920 921 freeifaddrs(ifap); 922 #else 923 int s; 924 unsigned int maxif; 925 struct ifreq *iflist; 926 struct ifconf ifconf; 927 struct ifreq *ifr, *ifrp, *ifr_end; 928 struct myaddrs *p; 929 struct sockaddr_in6 *sin6; 930 size_t siz; 931 char ifrbuf[sizeof(struct ifreq) + 1024]; 932 933 maxif = if_maxindex() + 1; 934 iflist = (struct ifreq *)malloc(maxif * BUFSIZ); /* XXX */ 935 if (!iflist) { 936 exit_failure("not enough core"); 937 /*NOTREACHED*/ 938 } 939 940 if ((s = socket(PF_INET, SOCK_DGRAM, 0)) < 0) { 941 exit_failure("socket(SOCK_DGRAM)"); 942 /*NOTREACHED*/ 943 } 944 memset(&ifconf, 0, sizeof(ifconf)); 945 ifconf.ifc_req = iflist; 946 ifconf.ifc_len = maxif * BUFSIZ; /* XXX */ 947 if (ioctl(s, SIOCGIFCONF, &ifconf) < 0) { 948 exit_failure("ioctl(SIOCGIFCONF)"); 949 /*NOTREACHED*/ 950 } 951 close(s); 952 953 /* Look for this interface in the list */ 954 ifr_end = (struct ifreq *) (ifconf.ifc_buf + ifconf.ifc_len); 955 for (ifrp = ifconf.ifc_req; 956 ifrp < ifr_end; 957 ifrp = (struct ifreq *)((char *)ifrp + siz)) { 958 memcpy(ifrbuf, ifrp, sizeof(*ifrp)); 959 ifr = (struct ifreq *)ifrbuf; 960 siz = ifr->ifr_addr.sa_len; 961 if (siz < sizeof(ifr->ifr_addr)) 962 siz = sizeof(ifr->ifr_addr); 963 siz += (sizeof(*ifrp) - sizeof(ifr->ifr_addr)); 964 if (siz > sizeof(ifrbuf)) { 965 /* ifr too big */ 966 break; 967 } 968 memcpy(ifrbuf, ifrp, siz); 969 970 switch (ifr->ifr_addr.sa_family) { 971 case AF_INET: 972 case AF_INET6: 973 p = (struct myaddrs *)malloc(sizeof(struct myaddrs) 974 + ifr->ifr_addr.sa_len); 975 if (!p) { 976 exit_failure("not enough core"); 977 /*NOTREACHED*/ 978 } 979 memcpy(p + 1, &ifr->ifr_addr, ifr->ifr_addr.sa_len); 980 p->next = myaddrs; 981 p->addr = (struct sockaddr *)(p + 1); 982 #ifdef __KAME__ 983 if (ifr->ifr_addr.sa_family == AF_INET6) { 984 sin6 = (struct sockaddr_in6 *)p->addr; 985 if (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr) 986 || IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr)) { 987 sin6->sin6_scope_id = 988 ntohs(*(u_int16_t *)&sin6->sin6_addr.s6_addr[2]); 989 sin6->sin6_addr.s6_addr[2] = 0; 990 sin6->sin6_addr.s6_addr[3] = 0; 991 } 992 } 993 #endif 994 myaddrs = p; 995 if (dflag) { 996 char hbuf[NI_MAXHOST]; 997 getnameinfo(p->addr, p->addr->sa_len, 998 hbuf, sizeof(hbuf), NULL, 0, 999 NI_NUMERICHOST); 1000 syslog(LOG_INFO, "my interface: %s %s", hbuf, ifr->ifr_name); 1001 } 1002 break; 1003 default: 1004 break; 1005 } 1006 } 1007 1008 free(iflist); 1009 #endif 1010 } 1011 1012 static void 1013 free_myaddrs() 1014 { 1015 struct myaddrs *p, *q; 1016 1017 p = myaddrs; 1018 while (p) { 1019 q = p->next; 1020 free(p); 1021 p = q; 1022 } 1023 myaddrs = NULL; 1024 } 1025 1026 static void 1027 update_myaddrs() 1028 { 1029 char msg[BUFSIZ]; 1030 int len; 1031 struct rt_msghdr *rtm; 1032 1033 len = read(sockfd, msg, sizeof(msg)); 1034 if (len < 0) { 1035 syslog(LOG_ERR, "read(PF_ROUTE) failed"); 1036 return; 1037 } 1038 rtm = (struct rt_msghdr *)msg; 1039 if (len < 4 || len < rtm->rtm_msglen) { 1040 syslog(LOG_ERR, "read(PF_ROUTE) short read"); 1041 return; 1042 } 1043 if (rtm->rtm_version != RTM_VERSION) { 1044 syslog(LOG_ERR, "routing socket version mismatch"); 1045 close(sockfd); 1046 sockfd = 0; 1047 return; 1048 } 1049 switch (rtm->rtm_type) { 1050 case RTM_NEWADDR: 1051 case RTM_DELADDR: 1052 case RTM_IFINFO: 1053 break; 1054 default: 1055 return; 1056 } 1057 /* XXX more filters here? */ 1058 1059 syslog(LOG_INFO, "update interface address list"); 1060 free_myaddrs(); 1061 grab_myaddrs(); 1062 } 1063 #endif /*USE_ROUTE*/ 1064 1065 static void 1066 usage() 1067 { 1068 fprintf(stderr, "usage: %s [-dp] [-f conf] service [serverpath [serverargs]]\n", 1069 faithdname); 1070 exit(0); 1071 } 1072
Indexes created Thu Oct 02 01:09:59 GMT 2025