1 /* 2 * Copyright (c) 1990, 1991, 1992, 1993, 1996 3 * The Regents of the University of California. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that: (1) source code distributions 7 * retain the above copyright notice and this paragraph in its entirety, (2) 8 * distributions including binary code include the above copyright notice and 9 * this paragraph in its entirety in the documentation or other materials 10 * provided with the distribution 11 * 12 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED 13 * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF 14 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. 15 * 16 * @(#) Copyright (c) 1990, 1991, 1992, 1993, 1996 The Regents of the University of California. All rights reserved. 17 * $FreeBSD: src/usr.sbin/rarpd/rarpd.c,v 1.41 2004/08/07 04:28:54 imp Exp $ 18 */ 19 20 /* 21 * rarpd - Reverse ARP Daemon 22 * 23 * Usage: rarpd -a [-dfsv] [-t directory] [hostname] 24 * rarpd [-dfsv] [-t directory] interface [hostname] 25 * 26 * 'hostname' is optional solely for backwards compatibility with Sun's rarpd. 27 * Currently, the argument is ignored. 28 */ 29 #include <sys/param.h> 30 #include <sys/file.h> 31 #include <sys/ioctl.h> 32 #include <sys/socket.h> 33 #include <sys/time.h> 34 35 #include <net/bpf.h> 36 #include <net/ethernet.h> 37 #include <net/if.h> 38 #include <net/if_types.h> 39 #include <net/if_dl.h> 40 #include <net/route.h> 41 42 #include <netinet/in.h> 43 #include <netinet/if_ether.h> 44 45 #include <arpa/inet.h> 46 47 #include <dirent.h> 48 #include <errno.h> 49 #include <ifaddrs.h> 50 #include <netdb.h> 51 #include <stdarg.h> 52 #include <stdio.h> 53 #include <string.h> 54 #include <syslog.h> 55 #include <stdlib.h> 56 #include <unistd.h> 57 58 /* Cast a struct sockaddr to a struct sockaddr_in */ 59 #define SATOSIN(sa) ((struct sockaddr_in *)(sa)) 60 61 #ifndef TFTP_DIR 62 #define TFTP_DIR "/tftpboot" 63 #endif 64 65 #define ARPSECS (20 * 60) /* as per code in netinet/if_ether.c */ 66 #define REVARP_REQUEST ARPOP_REVREQUEST 67 #define REVARP_REPLY ARPOP_REVREPLY 68 69 /* 70 * The structure for each interface. 71 */ 72 struct if_info { 73 struct if_info *ii_next; 74 int ii_fd; /* BPF file descriptor */ 75 in_addr_t ii_ipaddr; /* IP address */ 76 in_addr_t ii_netmask; /* subnet or net mask */ 77 u_char ii_eaddr[ETHER_ADDR_LEN]; /* ethernet address */ 78 char ii_ifname[IF_NAMESIZE]; 79 }; 80 81 /* 82 * The list of all interfaces that are being listened to. rarp_loop() 83 * "selects" on the descriptors in this list. 84 */ 85 struct if_info *iflist; 86 87 int verbose; /* verbose messages */ 88 const char *tftp_dir = TFTP_DIR; /* tftp directory */ 89 90 int dflag; /* messages to stdout/stderr, not syslog(3) */ 91 int sflag; /* ignore /tftpboot */ 92 93 static u_char zero[6]; 94 95 static int bpf_open(void); 96 static in_addr_t choose_ipaddr(in_addr_t **, in_addr_t, in_addr_t); 97 static char *eatoa(u_char *); 98 static int expand_syslog_m(const char *fmt, char **newfmt); 99 static void init(char *); 100 static void init_one(struct ifaddrs *, char *, int); 101 static char *intoa(in_addr_t); 102 static in_addr_t ipaddrtonetmask(in_addr_t); 103 static void logmsg(int, const char *, ...) __printflike(2, 3); 104 static int rarp_bootable(in_addr_t); 105 static int rarp_check(u_char *, u_int); 106 static void rarp_loop(void); 107 static int rarp_open(char *); 108 static void rarp_process(struct if_info *, u_char *, u_int); 109 static void rarp_reply(struct if_info *, struct ether_header *, 110 in_addr_t, u_int); 111 static void update_arptab(u_char *, in_addr_t); 112 static void usage(void); 113 114 int 115 main(int argc, char *argv[]) 116 { 117 int op; 118 char *ifname, *name; 119 120 int aflag = 0; /* listen on "all" interfaces */ 121 int fflag = 0; /* don't fork */ 122 123 if ((name = strrchr(argv[0], '/')) != NULL) 124 ++name; 125 else 126 name = argv[0]; 127 if (*name == '-') 128 ++name; 129 130 /* 131 * All error reporting is done through syslog, unless -d is specified 132 */ 133 openlog(name, LOG_PID | LOG_CONS, LOG_DAEMON); 134 135 opterr = 0; 136 while ((op = getopt(argc, argv, "adfst:v")) != -1) 137 switch (op) { 138 case 'a': 139 ++aflag; 140 break; 141 142 case 'd': 143 ++dflag; 144 break; 145 146 case 'f': 147 ++fflag; 148 break; 149 150 case 's': 151 ++sflag; 152 break; 153 154 case 't': 155 tftp_dir = optarg; 156 break; 157 158 case 'v': 159 ++verbose; 160 break; 161 162 default: 163 usage(); 164 /* NOTREACHED */ 165 } 166 argc -= optind; 167 argv += optind; 168 169 ifname = (aflag == 0) ? argv[0] : NULL; 170 171 if ((aflag && ifname) || (!aflag && ifname == NULL)) 172 usage(); 173 174 init(ifname); 175 176 if (!fflag) { 177 if (daemon(0,0)) { 178 logmsg(LOG_ERR, "cannot fork"); 179 exit(1); 180 } 181 } 182 rarp_loop(); 183 return(0); 184 } 185 186 /* 187 * Add to the interface list. 188 */ 189 static void 190 init_one(struct ifaddrs *ifa, char *target, int pass1) 191 { 192 struct if_info *ii, *ii2; 193 struct sockaddr_dl *ll; 194 int family; 195 196 family = ifa->ifa_addr->sa_family; 197 switch (family) { 198 case AF_INET: 199 if (pass1) 200 /* Consider only AF_LINK during pass1. */ 201 return; 202 /* FALLTHROUGH */ 203 case AF_LINK: 204 if (!(ifa->ifa_flags & IFF_UP) || 205 (ifa->ifa_flags & (IFF_LOOPBACK | IFF_POINTOPOINT))) 206 return; 207 break; 208 default: 209 return; 210 } 211 212 /* Don't bother going any further if not the target interface */ 213 if (target != NULL && strcmp(ifa->ifa_name, target) != 0) 214 return; 215 216 /* Look for interface in list */ 217 for (ii = iflist; ii != NULL; ii = ii->ii_next) 218 if (strcmp(ifa->ifa_name, ii->ii_ifname) == 0) 219 break; 220 221 if (pass1 && ii != NULL) 222 /* We've already seen that interface once. */ 223 return; 224 225 /* Allocate a new one if not found */ 226 if (ii == NULL) { 227 ii = (struct if_info *)malloc(sizeof(*ii)); 228 if (ii == NULL) { 229 logmsg(LOG_ERR, "malloc: %m"); 230 exit(1); 231 } 232 bzero(ii, sizeof(*ii)); 233 ii->ii_fd = -1; 234 strlcpy(ii->ii_ifname, ifa->ifa_name, sizeof(ii->ii_ifname)); 235 ii->ii_next = iflist; 236 iflist = ii; 237 } else if (!pass1 && ii->ii_ipaddr != 0) { 238 /* 239 * Second AF_INET definition for that interface: clone 240 * the existing one, and work on that cloned one. 241 * This must be another IP address for this interface, 242 * so avoid killing the previous configuration. 243 */ 244 ii2 = (struct if_info *)malloc(sizeof(*ii2)); 245 if (ii2 == NULL) { 246 logmsg(LOG_ERR, "malloc: %m"); 247 exit(1); 248 } 249 memcpy(ii2, ii, sizeof(*ii2)); 250 ii2->ii_fd = -1; 251 ii2->ii_next = iflist; 252 iflist = ii2; 253 254 ii = ii2; 255 } 256 257 switch (family) { 258 case AF_INET: 259 ii->ii_ipaddr = SATOSIN(ifa->ifa_addr)->sin_addr.s_addr; 260 ii->ii_netmask = SATOSIN(ifa->ifa_netmask)->sin_addr.s_addr; 261 if (ii->ii_netmask == 0) 262 ii->ii_netmask = ipaddrtonetmask(ii->ii_ipaddr); 263 if (ii->ii_fd < 0) 264 ii->ii_fd = rarp_open(ii->ii_ifname); 265 break; 266 267 case AF_LINK: 268 ll = (struct sockaddr_dl *)ifa->ifa_addr; 269 if (ll->sdl_type == IFT_ETHER) 270 bcopy(LLADDR(ll), ii->ii_eaddr, 6); 271 break; 272 } 273 } 274 /* 275 * Initialize all "candidate" interfaces that are in the system 276 * configuration list. A "candidate" is up, not loopback and not 277 * point to point. 278 */ 279 static void 280 init(char *target) 281 { 282 struct if_info *ii, *nii, *lii; 283 struct ifaddrs *ifhead, *ifa; 284 int error; 285 286 error = getifaddrs(&ifhead); 287 if (error) { 288 logmsg(LOG_ERR, "getifaddrs: %m"); 289 exit(1); 290 } 291 /* 292 * We make two passes over the list we have got. In the first 293 * one, we only collect AF_LINK interfaces, and initialize our 294 * list of interfaces from them. In the second pass, we 295 * collect the actual IP addresses from the AF_INET 296 * interfaces, and allow for the same interface name to appear 297 * multiple times (in case of more than one IP address). 298 */ 299 for (ifa = ifhead; ifa != NULL; ifa = ifa->ifa_next) 300 init_one(ifa, target, 1); 301 for (ifa = ifhead; ifa != NULL; ifa = ifa->ifa_next) 302 init_one(ifa, target, 0); 303 freeifaddrs(ifhead); 304 305 /* Throw away incomplete interfaces */ 306 lii = NULL; 307 for (ii = iflist; ii != NULL; ii = nii) { 308 nii = ii->ii_next; 309 if (ii->ii_ipaddr == 0 || 310 bcmp(ii->ii_eaddr, zero, 6) == 0) { 311 if (lii == NULL) 312 iflist = nii; 313 else 314 lii->ii_next = nii; 315 if (ii->ii_fd >= 0) 316 close(ii->ii_fd); 317 free(ii); 318 continue; 319 } 320 lii = ii; 321 } 322 323 /* Verbose stuff */ 324 if (verbose) 325 for (ii = iflist; ii != NULL; ii = ii->ii_next) 326 logmsg(LOG_DEBUG, "%s %s 0x%08x %s", 327 ii->ii_ifname, intoa(ntohl(ii->ii_ipaddr)), 328 (in_addr_t)ntohl(ii->ii_netmask), eatoa(ii->ii_eaddr)); 329 } 330 331 static void 332 usage(void) 333 { 334 fprintf(stderr, "%s\n%s\n", 335 "usage: rarpd -a [-dfsv] [-t directory]", 336 " rarpd [-dfsv] [-t directory] interface"); 337 exit(1); 338 } 339 340 static int 341 bpf_open(void) 342 { 343 int fd; 344 int n = 0; 345 char device[sizeof "/dev/bpf000"]; 346 347 /* 348 * Go through all the minors and find one that isn't in use. 349 */ 350 do { 351 sprintf(device, "/dev/bpf%d", n++); 352 fd = open(device, O_RDWR); 353 } while ((fd == -1) && (errno == EBUSY)); 354 355 if (fd == -1) { 356 logmsg(LOG_ERR, "%s: %m", device); 357 exit(1); 358 } 359 return fd; 360 } 361 362 /* 363 * Open a BPF file and attach it to the interface named 'device'. 364 * Set immediate mode, and set a filter that accepts only RARP requests. 365 */ 366 static int 367 rarp_open(char *device) 368 { 369 int fd; 370 struct ifreq ifr; 371 u_int dlt; 372 int immediate; 373 374 static struct bpf_insn insns[] = { 375 BPF_STMT(BPF_LD|BPF_H|BPF_ABS, 12), 376 BPF_JUMP(BPF_JMP|BPF_JEQ|BPF_K, ETHERTYPE_REVARP, 0, 3), 377 BPF_STMT(BPF_LD|BPF_H|BPF_ABS, 20), 378 BPF_JUMP(BPF_JMP|BPF_JEQ|BPF_K, REVARP_REQUEST, 0, 1), 379 BPF_STMT(BPF_RET|BPF_K, sizeof(struct ether_arp) + 380 sizeof(struct ether_header)), 381 BPF_STMT(BPF_RET|BPF_K, 0), 382 }; 383 static struct bpf_program filter = { 384 NELEM(insns), 385 insns 386 }; 387 388 fd = bpf_open(); 389 /* 390 * Set immediate mode so packets are processed as they arrive. 391 */ 392 immediate = 1; 393 if (ioctl(fd, BIOCIMMEDIATE, &immediate) == -1) { 394 logmsg(LOG_ERR, "BIOCIMMEDIATE: %m"); 395 exit(1); 396 } 397 strlcpy(ifr.ifr_name, device, sizeof(ifr.ifr_name)); 398 if (ioctl(fd, BIOCSETIF, (caddr_t)&ifr) == -1) { 399 logmsg(LOG_ERR, "BIOCSETIF: %m"); 400 exit(1); 401 } 402 /* 403 * Check that the data link layer is an Ethernet; this code won't 404 * work with anything else. 405 */ 406 if (ioctl(fd, BIOCGDLT, (caddr_t)&dlt) == -1) { 407 logmsg(LOG_ERR, "BIOCGDLT: %m"); 408 exit(1); 409 } 410 if (dlt != DLT_EN10MB) { 411 logmsg(LOG_ERR, "%s is not an ethernet", device); 412 exit(1); 413 } 414 /* 415 * Set filter program. 416 */ 417 if (ioctl(fd, BIOCSETF, (caddr_t)&filter) == -1) { 418 logmsg(LOG_ERR, "BIOCSETF: %m"); 419 exit(1); 420 } 421 return fd; 422 } 423 424 /* 425 * Perform various sanity checks on the RARP request packet. Return 426 * false on failure and log the reason. 427 */ 428 static int 429 rarp_check(u_char *p, u_int len) 430 { 431 struct ether_header *ep = (struct ether_header *)p; 432 struct ether_arp *ap = (struct ether_arp *)(p + sizeof(*ep)); 433 434 if (len < sizeof(*ep) + sizeof(*ap)) { 435 logmsg(LOG_ERR, "truncated request, got %u, expected %lu", 436 len, (u_long)(sizeof(*ep) + sizeof(*ap))); 437 return 0; 438 } 439 /* 440 * XXX This test might be better off broken out... 441 */ 442 if (ntohs(ep->ether_type) != ETHERTYPE_REVARP || 443 ntohs(ap->arp_hrd) != ARPHRD_ETHER || 444 ntohs(ap->arp_op) != REVARP_REQUEST || 445 ntohs(ap->arp_pro) != ETHERTYPE_IP || 446 ap->arp_hln != 6 || ap->arp_pln != 4) { 447 logmsg(LOG_DEBUG, "request fails sanity check"); 448 return 0; 449 } 450 if (bcmp((char *)&ep->ether_shost, (char *)&ap->arp_sha, 6) != 0) { 451 logmsg(LOG_DEBUG, "ether/arp sender address mismatch"); 452 return 0; 453 } 454 if (bcmp((char *)&ap->arp_sha, (char *)&ap->arp_tha, 6) != 0) { 455 logmsg(LOG_DEBUG, "ether/arp target address mismatch"); 456 return 0; 457 } 458 return 1; 459 } 460 461 /* 462 * Loop indefinitely listening for RARP requests on the 463 * interfaces in 'iflist'. 464 */ 465 static void 466 rarp_loop(void) 467 { 468 u_char *buf, *bp, *ep; 469 int cc, fd; 470 fd_set fds, listeners; 471 int bufsize, maxfd = 0; 472 struct if_info *ii; 473 474 if (iflist == NULL) { 475 logmsg(LOG_ERR, "no interfaces"); 476 exit(1); 477 } 478 if (ioctl(iflist->ii_fd, BIOCGBLEN, (caddr_t)&bufsize) == -1) { 479 logmsg(LOG_ERR, "BIOCGBLEN: %m"); 480 exit(1); 481 } 482 buf = malloc(bufsize); 483 if (buf == NULL) { 484 logmsg(LOG_ERR, "malloc: %m"); 485 exit(1); 486 } 487 488 while (1) { 489 /* 490 * Find the highest numbered file descriptor for select(). 491 * Initialize the set of descriptors to listen to. 492 */ 493 FD_ZERO(&fds); 494 for (ii = iflist; ii != NULL; ii = ii->ii_next) { 495 FD_SET(ii->ii_fd, &fds); 496 if (ii->ii_fd > maxfd) 497 maxfd = ii->ii_fd; 498 } 499 listeners = fds; 500 if (select(maxfd + 1, &listeners, NULL, NULL, NULL) == -1) { 501 /* Don't choke when we get ptraced */ 502 if (errno == EINTR) 503 continue; 504 logmsg(LOG_ERR, "select: %m"); 505 exit(1); 506 } 507 for (ii = iflist; ii != NULL; ii = ii->ii_next) { 508 fd = ii->ii_fd; 509 if (!FD_ISSET(fd, &listeners)) 510 continue; 511 again: 512 cc = read(fd, (char *)buf, bufsize); 513 /* Don't choke when we get ptraced */ 514 if ((cc == -1) && (errno == EINTR)) 515 goto again; 516 517 /* Loop through the packet(s) */ 518 #define bhp ((struct bpf_hdr *)bp) 519 bp = buf; 520 ep = bp + cc; 521 while (bp < ep) { 522 u_int caplen, hdrlen; 523 524 caplen = bhp->bh_caplen; 525 hdrlen = bhp->bh_hdrlen; 526 if (rarp_check(bp + hdrlen, caplen)) 527 rarp_process(ii, bp + hdrlen, caplen); 528 bp += BPF_WORDALIGN(hdrlen + caplen); 529 } 530 } 531 } 532 #undef bhp 533 } 534 535 /* 536 * True if this server can boot the host whose IP address is 'addr'. 537 * This check is made by looking in the tftp directory for the 538 * configuration file. 539 */ 540 static int 541 rarp_bootable(in_addr_t addr) 542 { 543 struct dirent *dent; 544 DIR *d; 545 char ipname[9]; 546 static DIR *dd = NULL; 547 548 sprintf(ipname, "%08X", (in_addr_t)ntohl(addr)); 549 550 /* 551 * If directory is already open, rewind it. Otherwise, open it. 552 */ 553 if ((d = dd) != NULL) 554 rewinddir(d); 555 else { 556 if (chdir(tftp_dir) == -1) { 557 logmsg(LOG_ERR, "chdir: %s: %m", tftp_dir); 558 exit(1); 559 } 560 d = opendir("."); 561 if (d == NULL) { 562 logmsg(LOG_ERR, "opendir: %m"); 563 exit(1); 564 } 565 dd = d; 566 } 567 while ((dent = readdir(d)) != NULL) 568 if (strncmp(dent->d_name, ipname, 8) == 0) 569 return 1; 570 return 0; 571 } 572 573 /* 574 * Given a list of IP addresses, 'alist', return the first address that 575 * is on network 'net'; 'netmask' is a mask indicating the network portion 576 * of the address. 577 */ 578 static in_addr_t 579 choose_ipaddr(in_addr_t **alist, in_addr_t net, in_addr_t netmask) 580 { 581 for (; *alist; ++alist) 582 if ((**alist & netmask) == net) 583 return **alist; 584 return 0; 585 } 586 587 /* 588 * Answer the RARP request in 'pkt', on the interface 'ii'. 'pkt' has 589 * already been checked for validity. The reply is overlaid on the request. 590 */ 591 static void 592 rarp_process(struct if_info *ii, u_char *pkt, u_int len) 593 { 594 struct ether_header *ep; 595 struct hostent *hp; 596 in_addr_t target_ipaddr; 597 char ename[256]; 598 599 ep = (struct ether_header *)pkt; 600 /* should this be arp_tha? */ 601 if (ether_ntohost(ename, (struct ether_addr *)&ep->ether_shost) != 0) { 602 logmsg(LOG_ERR, "cannot map %s to name", 603 eatoa(ep->ether_shost)); 604 return; 605 } 606 607 if ((hp = gethostbyname(ename)) == NULL) { 608 logmsg(LOG_ERR, "cannot map %s to IP address", ename); 609 return; 610 } 611 612 /* 613 * Choose correct address from list. 614 */ 615 if (hp->h_addrtype != AF_INET) { 616 logmsg(LOG_ERR, "cannot handle non IP addresses for %s", 617 ename); 618 return; 619 } 620 target_ipaddr = choose_ipaddr((in_addr_t **)hp->h_addr_list, 621 ii->ii_ipaddr & ii->ii_netmask, 622 ii->ii_netmask); 623 if (target_ipaddr == 0) { 624 logmsg(LOG_ERR, "cannot find %s on net %s", 625 ename, intoa(ntohl(ii->ii_ipaddr & ii->ii_netmask))); 626 return; 627 } 628 if (sflag || rarp_bootable(target_ipaddr)) 629 rarp_reply(ii, ep, target_ipaddr, len); 630 else if (verbose > 1) 631 logmsg(LOG_INFO, "%s %s at %s DENIED (not bootable)", 632 ii->ii_ifname, 633 eatoa(ep->ether_shost), 634 intoa(ntohl(target_ipaddr))); 635 } 636 637 /* 638 * Poke the kernel arp tables with the ethernet/ip address combinataion 639 * given. When processing a reply, we must do this so that the booting 640 * host (i.e. the guy running rarpd), won't try to ARP for the hardware 641 * address of the guy being booted (he cannot answer the ARP). 642 */ 643 struct sockaddr_inarp sin_inarp = { 644 sizeof(struct sockaddr_inarp), AF_INET, 0, 645 {0}, 646 {0}, 647 0, 0 648 }; 649 struct sockaddr_dl sin_dl = { 650 sizeof(struct sockaddr_dl), AF_LINK, 0, IFT_ETHER, 0, 6, 651 0, "" 652 }; 653 struct { 654 struct rt_msghdr rthdr; 655 char rtspace[512]; 656 } rtmsg; 657 658 static void 659 update_arptab(u_char *ep, in_addr_t ipaddr) 660 { 661 int cc; 662 struct sockaddr_inarp *ar, *ar2; 663 struct sockaddr_dl *ll, *ll2; 664 struct rt_msghdr *rt; 665 int xtype, xindex; 666 static pid_t pid; 667 int r; 668 struct timespec sp; 669 static int seq; 670 671 r = socket(PF_ROUTE, SOCK_RAW, 0); 672 if (r == -1) { 673 logmsg(LOG_ERR, "raw route socket: %m"); 674 exit(1); 675 } 676 pid = getpid(); 677 678 ar = &sin_inarp; 679 ar->sin_addr.s_addr = ipaddr; 680 ll = &sin_dl; 681 bcopy(ep, LLADDR(ll), 6); 682 683 /* Get the type and interface index */ 684 rt = &rtmsg.rthdr; 685 bzero(rt, sizeof(rtmsg)); 686 rt->rtm_version = RTM_VERSION; 687 rt->rtm_addrs = RTA_DST; 688 rt->rtm_type = RTM_GET; 689 rt->rtm_seq = ++seq; 690 ar2 = (struct sockaddr_inarp *)rtmsg.rtspace; 691 bcopy(ar, ar2, sizeof(*ar)); 692 rt->rtm_msglen = sizeof(*rt) + sizeof(*ar); 693 errno = 0; 694 if ((write(r, rt, rt->rtm_msglen) == -1) && (errno != ESRCH)) { 695 logmsg(LOG_ERR, "rtmsg get write: %m"); 696 close(r); 697 return; 698 } 699 do { 700 cc = read(r, rt, sizeof(rtmsg)); 701 } while (cc > 0 && (rt->rtm_seq != seq || rt->rtm_pid != pid)); 702 if (cc == -1) { 703 logmsg(LOG_ERR, "rtmsg get read: %m"); 704 close(r); 705 return; 706 } 707 ll2 = (struct sockaddr_dl *)((u_char *)ar2 + ar2->sin_len); 708 if (ll2->sdl_family != AF_LINK) { 709 /* 710 * XXX I think this means the ip address is not on a 711 * directly connected network (the family is AF_INET in 712 * this case). 713 */ 714 logmsg(LOG_ERR, "bogus link family (%d) wrong net for %08X?\n", 715 ll2->sdl_family, ipaddr); 716 close(r); 717 return; 718 } 719 xtype = ll2->sdl_type; 720 xindex = ll2->sdl_index; 721 722 clock_gettime(CLOCK_MONOTONIC, &sp); 723 724 /* Set the new arp entry */ 725 bzero(rt, sizeof(rtmsg)); 726 rt->rtm_version = RTM_VERSION; 727 rt->rtm_addrs = RTA_DST | RTA_GATEWAY; 728 rt->rtm_inits = RTV_EXPIRE; 729 rt->rtm_rmx.rmx_expire = sp.tv_sec + ARPSECS; 730 rt->rtm_flags = RTF_HOST | RTF_STATIC; 731 rt->rtm_type = RTM_ADD; 732 rt->rtm_seq = ++seq; 733 734 bcopy(ar, ar2, sizeof(*ar)); 735 736 ll2 = (struct sockaddr_dl *)((u_char *)ar2 + sizeof(*ar2)); 737 bcopy(ll, ll2, sizeof(*ll)); 738 ll2->sdl_type = xtype; 739 ll2->sdl_index = xindex; 740 741 rt->rtm_msglen = sizeof(*rt) + sizeof(*ar2) + sizeof(*ll2); 742 errno = 0; 743 if ((write(r, rt, rt->rtm_msglen) == -1) && (errno != EEXIST)) { 744 logmsg(LOG_ERR, "rtmsg add write: %m"); 745 close(r); 746 return; 747 } 748 do { 749 cc = read(r, rt, sizeof(rtmsg)); 750 } while (cc > 0 && (rt->rtm_seq != seq || rt->rtm_pid != pid)); 751 close(r); 752 if (cc == -1) { 753 logmsg(LOG_ERR, "rtmsg add read: %m"); 754 return; 755 } 756 } 757 758 /* 759 * Build a reverse ARP packet and sent it out on the interface. 760 * 'ep' points to a valid REVARP_REQUEST. The REVARP_REPLY is built 761 * on top of the request, then written to the network. 762 * 763 * RFC 903 defines the ether_arp fields as follows. The following comments 764 * are taken (more or less) straight from this document. 765 * 766 * REVARP_REQUEST 767 * 768 * arp_sha is the hardware address of the sender of the packet. 769 * arp_spa is undefined. 770 * arp_tha is the 'target' hardware address. 771 * In the case where the sender wishes to determine his own 772 * protocol address, this, like arp_sha, will be the hardware 773 * address of the sender. 774 * arp_tpa is undefined. 775 * 776 * REVARP_REPLY 777 * 778 * arp_sha is the hardware address of the responder (the sender of the 779 * reply packet). 780 * arp_spa is the protocol address of the responder (see the note below). 781 * arp_tha is the hardware address of the target, and should be the same as 782 * that which was given in the request. 783 * arp_tpa is the protocol address of the target, that is, the desired address. 784 * 785 * Note that the requirement that arp_spa be filled in with the responder's 786 * protocol is purely for convenience. For instance, if a system were to use 787 * both ARP and RARP, then the inclusion of the valid protocol-hardware 788 * address pair (arp_spa, arp_sha) may eliminate the need for a subsequent 789 * ARP request. 790 */ 791 static void 792 rarp_reply(struct if_info *ii, struct ether_header *ep, in_addr_t ipaddr, 793 u_int len) 794 { 795 u_int n; 796 struct ether_arp *ap = (struct ether_arp *)(ep + 1); 797 798 update_arptab((u_char *)&ap->arp_sha, ipaddr); 799 800 /* 801 * Build the rarp reply by modifying the rarp request in place. 802 */ 803 ap->arp_op = htons(REVARP_REPLY); 804 805 #ifdef BROKEN_BPF 806 ep->ether_type = ETHERTYPE_REVARP; 807 #endif 808 bcopy((char *)&ap->arp_sha, (char *)&ep->ether_dhost, 6); 809 bcopy((char *)ii->ii_eaddr, (char *)&ep->ether_shost, 6); 810 bcopy((char *)ii->ii_eaddr, (char *)&ap->arp_sha, 6); 811 812 bcopy((char *)&ipaddr, (char *)ap->arp_tpa, 4); 813 /* Target hardware is unchanged. */ 814 bcopy((char *)&ii->ii_ipaddr, (char *)ap->arp_spa, 4); 815 816 /* Zero possible garbage after packet. */ 817 bzero((char *)ep + (sizeof(*ep) + sizeof(*ap)), 818 len - (sizeof(*ep) + sizeof(*ap))); 819 n = write(ii->ii_fd, (char *)ep, len); 820 if (n != len) 821 logmsg(LOG_ERR, "write: only %d of %d bytes written", n, len); 822 if (verbose) 823 logmsg(LOG_INFO, "%s %s at %s REPLIED", ii->ii_ifname, 824 eatoa(ap->arp_tha), 825 intoa(ntohl(ipaddr))); 826 } 827 828 /* 829 * Get the netmask of an IP address. This routine is used if 830 * SIOCGIFNETMASK doesn't work. 831 */ 832 static in_addr_t 833 ipaddrtonetmask(in_addr_t addr) 834 { 835 addr = ntohl(addr); 836 if (IN_CLASSA(addr)) 837 return htonl(IN_CLASSA_NET); 838 if (IN_CLASSB(addr)) 839 return htonl(IN_CLASSB_NET); 840 if (IN_CLASSC(addr)) 841 return htonl(IN_CLASSC_NET); 842 logmsg(LOG_DEBUG, "unknown IP address class: %08X", addr); 843 return htonl(0xffffffff); 844 } 845 846 /* 847 * A faster replacement for inet_ntoa(). 848 */ 849 static char * 850 intoa(in_addr_t addr) 851 { 852 char *cp; 853 u_int byte; 854 int n; 855 static char buf[sizeof(".xxx.xxx.xxx.xxx")]; 856 857 cp = &buf[sizeof buf]; 858 *--cp = '\0'; 859 860 n = 4; 861 do { 862 byte = addr & 0xff; 863 *--cp = byte % 10 + '0'; 864 byte /= 10; 865 if (byte > 0) { 866 *--cp = byte % 10 + '0'; 867 byte /= 10; 868 if (byte > 0) 869 *--cp = byte + '0'; 870 } 871 *--cp = '.'; 872 addr >>= 8; 873 } while (--n > 0); 874 875 return cp + 1; 876 } 877 878 static char * 879 eatoa(u_char *ea) 880 { 881 static char buf[sizeof("xx:xx:xx:xx:xx:xx")]; 882 883 sprintf(buf, "%x:%x:%x:%x:%x:%x", 884 ea[0], ea[1], ea[2], ea[3], ea[4], ea[5]); 885 return (buf); 886 } 887 888 static void 889 logmsg(int pri, const char *fmt, ...) 890 { 891 va_list v; 892 FILE *fp; 893 char *newfmt; 894 895 va_start(v, fmt); 896 if (dflag) { 897 if (pri == LOG_ERR) 898 fp = stderr; 899 else 900 fp = stdout; 901 if (expand_syslog_m(fmt, &newfmt) == -1) { 902 vfprintf(fp, fmt, v); 903 } else { 904 vfprintf(fp, newfmt, v); 905 free(newfmt); 906 } 907 fputs("\n", fp); 908 fflush(fp); 909 } else { 910 vsyslog(pri, fmt, v); 911 } 912 va_end(v); 913 } 914 915 static int 916 expand_syslog_m(const char *fmt, char **newfmt) 917 { 918 const char *str, *m; 919 char *p, *np; 920 921 p = strdup(""); 922 str = fmt; 923 while ((m = strstr(str, "%m")) != NULL) { 924 asprintf(&np, "%s%.*s%s", p, (int)(m - str), 925 str, strerror(errno)); 926 free(p); 927 if (np == NULL) { 928 errno = ENOMEM; 929 return (-1); 930 } 931 p = np; 932 str = m + 2; 933 } 934 935 if (*str != '\0') { 936 asprintf(&np, "%s%s", p, str); 937 free(p); 938 if (np == NULL) { 939 errno = ENOMEM; 940 return (-1); 941 } 942 p = np; 943 } 944 945 *newfmt = p; 946 return (0); 947 } 948