#include <sys/cdefs.h>
#ifndef lint
__unused char copyright[] =
"@(#) Copyright (c) 1990 The Regents of the University of California.\n\
All rights reserved.\n";
#endif
#ifndef lint
__unused static char rcsid[] =
"@(#) $Id: rarpd.c,v 1.3 2006/04/05 03:13:14 lindak Exp $";
#endif
#include <stdio.h>
#include <stdlib.h>
#include <syslog.h>
#include <string.h>
#include <strings.h>
#include <sys/types.h>
#include <unistd.h>
#include <sys/time.h>
#include <net/bpf.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <net/if.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <netinet/in.h>
#include <netinet/if_ether.h>
#include <sys/errno.h>
#include <sys/file.h>
#include <netdb.h>
#include <arpa/inet.h>
#include <dirent.h>
#define FATAL 1
#define NONFATAL 0
struct if_info {
int ii_fd;
u_char ii_eaddr[6];
u_long ii_ipaddr;
u_long ii_netmask;
struct if_info *ii_next;
};
struct if_info *iflist;
int rarp_open __P((char *));
int rarp_bootable __P((u_long));
void init_one __P((char *));
void init_all __P((void));
void rarp_loop __P((void));
void lookup_eaddr __P((char *, u_char *));
void lookup_ipaddr __P((char *, u_long *, u_long *));
void usage __P((void));
void rarp_process __P((struct if_info *, u_char *));
void rarp_reply __P((struct if_info *, struct ether_header *, u_long));
void update_arptab __P((u_char *, u_long));
void err __P((int, const char *,...));
void debug __P((const char *,...));
u_long ipaddrtonetmask __P((u_long));
int aflag = 0;
int dflag = 0;
int fflag = 0;
int
main(argc, argv)
int argc;
char **argv;
{
int op, pid, devnull, f;
char *ifname, *hostname, *name;
extern char *optarg;
extern int optind, opterr;
if (name = strrchr(argv[0], '/'))
++name;
else
name = argv[0];
if (*name == '-')
++name;
openlog(name, LOG_PID | LOG_CONS, LOG_DAEMON);
opterr = 0;
while ((op = getopt(argc, argv, "adf")) != EOF) {
switch (op) {
case 'a':
++aflag;
break;
case 'd':
++dflag;
break;
case 'f':
++fflag;
break;
default:
usage();
}
}
ifname = argv[optind++];
hostname = ifname ? argv[optind] : 0;
if ((aflag && ifname) || (!aflag && ifname == 0))
usage();
if (aflag)
init_all();
else
init_one(ifname);
if ((!fflag) && (!dflag)) {
pid = fork();
if (pid > 0)
exit(0);
else
if (pid == -1) {
err(FATAL, "cannot fork");
}
f = open("/dev/tty", O_RDWR);
if (f >= 0) {
if (ioctl(f, TIOCNOTTY, 0) < 0) {
err(FATAL, "TIOCNOTTY: %s", strerror(errno));
}
(void) close(f);
}
(void) chdir("/");
(void) setpgid(0, getpid());
devnull = open("/dev/null", O_RDWR);
if (devnull >= 0) {
(void) dup2(devnull, 0);
(void) dup2(devnull, 1);
(void) dup2(devnull, 2);
if (devnull > 2)
(void) close(devnull);
}
}
rarp_loop();
return 0;
}
void
init_one(ifname)
char *ifname;
{
struct if_info *p;
p = (struct if_info *)malloc(sizeof(*p));
if (p == 0) {
err(FATAL, "malloc: %s", strerror(errno));
}
p->ii_next = iflist;
iflist = p;
p->ii_fd = rarp_open(ifname);
lookup_eaddr(ifname, p->ii_eaddr);
lookup_ipaddr(ifname, &p->ii_ipaddr, &p->ii_netmask);
}
void
init_all()
{
char inbuf[8192];
struct ifconf ifc;
struct ifreq *ifr;
int fd;
int i, len;
if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
err(FATAL, "socket: %s", strerror(errno));
}
ifc.ifc_len = sizeof(inbuf);
ifc.ifc_buf = inbuf;
if (ioctl(fd, SIOCGIFCONF, (caddr_t)&ifc) < 0 ||
ifc.ifc_len < sizeof(struct ifreq)) {
err(FATAL, "init_all: SIOCGIFCONF: %s", strerror(errno));
}
ifr = ifc.ifc_req;
for (i = 0; i < ifc.ifc_len;
i += len, ifr = (struct ifreq *)((caddr_t)ifr + len)) {
len = sizeof(ifr->ifr_name) + ifr->ifr_addr.sa_len;
if (ioctl(fd, SIOCGIFFLAGS, (caddr_t)ifr) < 0) {
err(FATAL, "init_all: SIOCGIFFLAGS: %s",
strerror(errno));
}
if ((ifr->ifr_flags &
(IFF_UP | IFF_LOOPBACK | IFF_POINTOPOINT)) != IFF_UP)
continue;
init_one(ifr->ifr_name);
}
(void) close(fd);
}
void
usage()
{
(void) fprintf(stderr, "usage: rarpd -a [ -d -f ]\n");
(void) fprintf(stderr, " rarpd [ -d -f ] interface\n");
exit(1);
}
static int
bpf_open()
{
int fd;
int n = 0;
char device[sizeof "/dev/bpf000"];
do {
(void) sprintf(device, "/dev/bpf%d", n++);
fd = open(device, O_RDWR);
} while (fd < 0 && errno == EBUSY);
if (fd < 0) {
err(FATAL, "%s: %s", device, strerror(errno));
}
return fd;
}
int
rarp_open(device)
char *device;
{
int fd;
struct ifreq ifr;
u_int dlt;
int immediate;
static struct bpf_insn insns[] = {
BPF_STMT(BPF_LD | BPF_H | BPF_ABS, 12),
BPF_JUMP(BPF_JMP | BPF_JEQ | BPF_K, ETHERTYPE_REVARP, 0, 3),
BPF_STMT(BPF_LD | BPF_H | BPF_ABS, 20),
BPF_JUMP(BPF_JMP | BPF_JEQ | BPF_K, ARPOP_REVREQUEST, 0, 1),
BPF_STMT(BPF_RET | BPF_K, sizeof(struct ether_arp) +
sizeof(struct ether_header)),
BPF_STMT(BPF_RET | BPF_K, 0),
};
static struct bpf_program filter = {
sizeof insns / sizeof(insns[0]),
insns
};
fd = bpf_open();
immediate = 1;
if (ioctl(fd, BIOCIMMEDIATE, &immediate) < 0) {
err(FATAL, "BIOCIMMEDIATE: %s", strerror(errno));
}
(void) strncpy(ifr.ifr_name, device, sizeof ifr.ifr_name);
if (ioctl(fd, BIOCSETIF, (caddr_t) & ifr) < 0) {
err(FATAL, "BIOCSETIF: %s", strerror(errno));
}
if (ioctl(fd, BIOCGDLT, (caddr_t) & dlt) < 0) {
err(FATAL, "BIOCGDLT: %s", strerror(errno));
}
if (dlt != DLT_EN10MB) {
err(FATAL, "%s is not an ethernet", device);
}
if (ioctl(fd, BIOCSETF, (caddr_t) & filter) < 0) {
err(FATAL, "BIOCSETF: %s", strerror(errno));
}
return fd;
}
static int
rarp_check(p, len)
u_char *p;
int len;
{
struct ether_header *ep = (struct ether_header *) p;
struct ether_arp *ap = (struct ether_arp *) (p + sizeof(*ep));
(void) debug("got a packet");
if (len < sizeof(*ep) + sizeof(*ap)) {
err(NONFATAL, "truncated request");
return 0;
}
if (ntohs (ep->ether_type) != ETHERTYPE_REVARP ||
ntohs (ap->arp_hrd) != ARPHRD_ETHER ||
ntohs (ap->arp_op) != ARPOP_REVREQUEST ||
ntohs (ap->arp_pro) != ETHERTYPE_IP ||
ap->arp_hln != 6 || ap->arp_pln != 4) {
err(NONFATAL, "request fails sanity check");
return 0;
}
if (bcmp((char *) &ep->ether_shost, (char *) &ap->arp_sha, 6) != 0) {
err(NONFATAL, "ether/arp sender address mismatch");
return 0;
}
if (bcmp((char *) &ap->arp_sha, (char *) &ap->arp_tha, 6) != 0) {
err(NONFATAL, "ether/arp target address mismatch");
return 0;
}
return 1;
}
void
rarp_loop()
{
u_char *buf, *bp, *ep;
int cc, fd;
fd_set fds, listeners;
int bufsize, maxfd = 0;
struct if_info *ii;
if (iflist == 0) {
err(FATAL, "no interfaces");
}
if (ioctl(iflist->ii_fd, BIOCGBLEN, (caddr_t) & bufsize) < 0) {
err(FATAL, "BIOCGBLEN: %s", strerror(errno));
}
buf = (u_char *) malloc((unsigned) bufsize);
if (buf == 0) {
err(FATAL, "malloc: %s", strerror(errno));
}
FD_ZERO(&fds);
for (ii = iflist; ii; ii = ii->ii_next) {
FD_SET(ii->ii_fd, &fds);
if (ii->ii_fd > maxfd)
maxfd = ii->ii_fd;
}
while (1) {
listeners = fds;
if (select(maxfd + 1, &listeners, (struct fd_set *) 0,
(struct fd_set *) 0, (struct timeval *) 0) < 0) {
err(FATAL, "select: %s", strerror(errno));
}
for (ii = iflist; ii; ii = ii->ii_next) {
fd = ii->ii_fd;
if (!FD_ISSET(fd, &listeners))
continue;
again:
cc = read(fd, (char *) buf, bufsize);
if (cc < 0 && errno == EINTR)
goto again;
if (cc < 0) {
if (errno == EINVAL &&
(lseek(fd, 0, SEEK_CUR) + bufsize) < 0) {
(void) lseek(fd, 0, 0);
goto again;
}
err(FATAL, "read: %s", strerror(errno));
}
#define bhp ((struct bpf_hdr *)bp)
bp = buf;
ep = bp + cc;
while (bp < ep) {
register int caplen, hdrlen;
caplen = bhp->bh_caplen;
hdrlen = bhp->bh_hdrlen;
if (rarp_check(bp + hdrlen, caplen))
rarp_process(ii, bp + hdrlen);
bp += BPF_WORDALIGN(hdrlen + caplen);
}
}
}
}
#ifndef TFTP_DIR
#define TFTP_DIR "/tftpboot"
#endif
int
rarp_bootable(addr)
u_long addr;
{
register struct dirent *dent;
register DIR *d;
char ipname[9];
static DIR *dd = 0;
(void) sprintf(ipname, "%08lX", addr);
if (d = dd)
rewinddir(d);
else {
if (chdir(TFTP_DIR) == -1) {
err(FATAL, "chdir: %s", strerror(errno));
}
d = opendir(".");
if (d == 0) {
err(FATAL, "opendir: %s", strerror(errno));
}
dd = d;
}
while (dent = readdir(d))
if (strncmp(dent->d_name, ipname, 8) == 0)
return 1;
return 0;
}
u_long
choose_ipaddr(alist, net, netmask)
u_long **alist;
u_long net;
u_long netmask;
{
for (; *alist; ++alist) {
if ((**alist & netmask) == net)
return **alist;
}
return 0;
}
void
rarp_process(ii, pkt)
struct if_info *ii;
u_char *pkt;
{
struct ether_header *ep;
struct hostent *hp;
u_long target_ipaddr;
char ename[256];
struct in_addr in;
ep = (struct ether_header *) pkt;
if (ether_ntohost(ename, (struct ether_addr *)&ep->ether_shost) != 0 ||
(hp = gethostbyname(ename)) == 0)
return;
if (hp->h_addrtype != AF_INET) {
err(FATAL, "cannot handle non IP addresses");
}
target_ipaddr = choose_ipaddr((u_long **) hp->h_addr_list,
ii->ii_ipaddr & ii->ii_netmask, ii->ii_netmask);
if (target_ipaddr == 0) {
in.s_addr = ii->ii_ipaddr & ii->ii_netmask;
err(NONFATAL, "cannot find %s on net %s\n",
ename, inet_ntoa(in));
return;
}
if (rarp_bootable(htonl(target_ipaddr)))
rarp_reply(ii, ep, target_ipaddr);
}
void
lookup_eaddr(ifname, eaddr)
char *ifname;
u_char *eaddr;
{
char inbuf[8192];
struct ifconf ifc;
struct ifreq *ifr;
struct sockaddr_dl *sdl;
int fd;
int i, len;
if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
err(FATAL, "socket: %s", strerror(errno));
}
ifc.ifc_len = sizeof(inbuf);
ifc.ifc_buf = inbuf;
if (ioctl(fd, SIOCGIFCONF, (caddr_t)&ifc) < 0 ||
ifc.ifc_len < sizeof(struct ifreq)) {
err(FATAL, "lookup_eaddr: SIOGIFCONF: %s", strerror(errno));
}
ifr = ifc.ifc_req;
for (i = 0; i < ifc.ifc_len;
i += len, ifr = (struct ifreq *)((caddr_t)ifr + len)) {
len = sizeof(ifr->ifr_name) + ifr->ifr_addr.sa_len;
sdl = (struct sockaddr_dl *)&ifr->ifr_addr;
if (sdl->sdl_family != AF_LINK || sdl->sdl_type != IFT_ETHER ||
sdl->sdl_alen != 6)
continue;
if (!strncmp(ifr->ifr_name, ifname, sizeof(ifr->ifr_name))) {
bcopy((caddr_t)LLADDR(sdl), (caddr_t)eaddr, 6);
if (dflag)
fprintf(stderr, "%s: %x:%x:%x:%x:%x:%x\n",
ifr->ifr_name, eaddr[0], eaddr[1],
eaddr[2], eaddr[3], eaddr[4], eaddr[5]);
return;
}
}
err(FATAL, "lookup_eaddr: Never saw interface `%s'!", ifname);
}
void
lookup_ipaddr(ifname, addrp, netmaskp)
char *ifname;
u_long *addrp;
u_long *netmaskp;
{
int fd;
struct ifreq ifr;
if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
err(FATAL, "socket: %s", strerror(errno));
}
(void) strncpy(ifr.ifr_name, ifname, sizeof ifr.ifr_name);
if (ioctl(fd, SIOCGIFADDR, (char *) &ifr) < 0) {
err(FATAL, "SIOCGIFADDR: %s", strerror(errno));
}
*addrp = ((struct sockaddr_in *) & ifr.ifr_addr)->sin_addr.s_addr;
if (ioctl(fd, SIOCGIFNETMASK, (char *) &ifr) < 0) {
perror("SIOCGIFNETMASK");
exit(1);
}
*netmaskp = ((struct sockaddr_in *) & ifr.ifr_addr)->sin_addr.s_addr;
if (*netmaskp == 0)
*netmaskp = ipaddrtonetmask(*addrp);
(void) close(fd);
}
void
update_arptab(ep, ipaddr)
u_char *ep;
u_long ipaddr;
{
struct arpreq request;
struct sockaddr_in *sin;
request.arp_flags = 0;
sin = (struct sockaddr_in *) & request.arp_pa;
sin->sin_family = AF_INET;
sin->sin_addr.s_addr = ipaddr;
request.arp_ha.sa_family = AF_UNSPEC;
request.arp_ha.sa_len = 16;
bcopy((char *) ep, (char *) request.arp_ha.sa_data, 6);
#if 0
s = socket(AF_INET, SOCK_DGRAM, 0);
if (ioctl(s, SIOCSARP, (caddr_t) & request) < 0) {
err(NONFATAL, "SIOCSARP: %s", strerror(errno));
}
(void) close(s);
#endif
}
void
rarp_reply(ii, ep, ipaddr)
struct if_info *ii;
struct ether_header *ep;
u_long ipaddr;
{
int n;
struct ether_arp *ap = (struct ether_arp *) (ep + 1);
int len;
update_arptab((u_char *) & ap->arp_sha, ipaddr);
ep->ether_type = htons(ETHERTYPE_REVARP);
ap->ea_hdr.ar_hrd = htons(ARPHRD_ETHER);
ap->ea_hdr.ar_pro = htons(ETHERTYPE_IP);
ap->arp_op = htons(ARPOP_REVREPLY);
bcopy((char *) &ap->arp_sha, (char *) &ep->ether_dhost, 6);
bcopy((char *) ii->ii_eaddr, (char *) &ep->ether_shost, 6);
bcopy((char *) ii->ii_eaddr, (char *) &ap->arp_sha, 6);
bcopy((char *) &ipaddr, (char *) ap->arp_tpa, 4);
bcopy((char *) &ii->ii_ipaddr, (char *) ap->arp_spa, 4);
len = sizeof(*ep) + sizeof(*ap);
n = write(ii->ii_fd, (char *) ep, len);
if (n != len) {
err(NONFATAL, "write: only %d of %d bytes written", n, len);
}
}
u_long
ipaddrtonetmask(addr)
u_long addr;
{
if (IN_CLASSA(addr))
return IN_CLASSA_NET;
if (IN_CLASSB(addr))
return IN_CLASSB_NET;
if (IN_CLASSC(addr))
return IN_CLASSC_NET;
err(FATAL, "unknown IP address class: %08X", addr);
return 0;
}
#if __STDC__
#include <stdarg.h>
#else
#include <varargs.h>
#endif
void
#if __STDC__
err(int fatal, const char *fmt,...)
#else
err(fmt, va_alist)
int fatal;
char *fmt;
va_dcl
#endif
{
va_list ap;
#if __STDC__
va_start(ap, fmt);
#else
va_start(ap);
#endif
if (dflag) {
if (fatal)
(void) fprintf(stderr, "rarpd: error: ");
else
(void) fprintf(stderr, "rarpd: warning: ");
(void) vfprintf(stderr, fmt, ap);
(void) fprintf(stderr, "\n");
}
vsyslog(LOG_ERR, fmt, ap);
va_end(ap);
if (fatal)
exit(1);
}
void
#if __STDC__
debug(const char *fmt,...)
#else
debug(fmt, va_alist)
char *fmt;
va_dcl
#endif
{
va_list ap;
if (dflag) {
#if __STDC__
va_start(ap, fmt);
#else
va_start(ap);
#endif
(void) fprintf(stderr, "rarpd: ");
(void) vfprintf(stderr, fmt, ap);
va_end(ap);
(void) fprintf(stderr, "\n");
}
}