#include <sys/param.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <sys/sysctl.h>
#include <sys/types.h>
#include <net/if.h>
#include <net/route.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <netinet/in.h>
#include <netinet/if_ether.h>
#include <arpa/inet.h>
#include <netdb.h>
#include <netproto/802_11/ieee80211_dragonfly.h>
#include <netproto/mpls/mpls.h>
#include <ctype.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#include <inttypes.h>
#include <paths.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sysexits.h>
#include <unistd.h>
#include <ifaddrs.h>
#include "extern.h"
union sockunion {
struct sockaddr sa;
struct sockaddr_in sin;
#ifdef INET6
struct sockaddr_in6 sin6;
#endif
struct sockaddr_mpls smpls;
struct sockaddr_dl sdl;
struct sockaddr_inarp sinarp;
struct sockaddr_storage ss;
} so_dst, so_gate, so_mask, so_genmask, so_ifa, so_ifp, so_mpls1,
so_mpls2, so_mpls3;
typedef union sockunion *sup;
int nflag, wflag;
int cpuflag = -1;
static struct keytab {
const char *kt_cp;
int kt_i;
} const keywords[] = {
#include "keywords.h"
{0, 0}
};
static struct sockaddr_in so_gate_tried;
static struct rt_metrics rt_metrics;
static int pid, rtm_addrs;
static int s;
static int forcehost, forcenet, af, qflag, tflag;
static int iflag, verbose, aflen = sizeof(struct sockaddr_in);
static int locking, lockrest, debugonly;
static int mplsop, popcount, pushcount, swapcount;
static u_long rtm_inits;
static uid_t uid;
static void flushroutes(int, char **);
static void set_metric(char *, int);
static void newroute(int, char **) __dead2;
static void inet_makenetandmask(u_long, struct sockaddr_in *, u_long);
static void interfaces(void);
static void monitor(void) __dead2;
static void sockaddr(const char *, struct sockaddr *);
static void sodump(sup, const char *);
static void bprintf(FILE *, int, u_char *);
static void print_getmsg(struct rt_msghdr *, int);
static void print_rtmsg(struct rt_msghdr *, int);
static void pmsg_common(struct rt_msghdr *);
static void pmsg_addrs(char *, int);
static void mask_addr(void);
static int getaddr(int, const char *, struct hostent **);
static int rtmsg(int, int);
static int prefixlen(const char *);
#ifdef INET6
static int inet6_makenetandmask(struct sockaddr_in6 *, const char *);
#endif
#define PRIETHER "02x:%02x:%02x:%02x:%02x:%02x"
#define PRIETHER_ARGS(__enaddr) (__enaddr)[0], (__enaddr)[1], (__enaddr)[2], \
(__enaddr)[3], (__enaddr)[4], (__enaddr)[5]
void
usage(const char *cp)
{
if (cp != NULL)
warnx("bad keyword: %s", cp);
fprintf(stderr, "usage: route [-dnqtvw] [-c cpu] command [[modifiers] args]\n");
exit(EX_USAGE);
}
int
main(int argc, char **argv)
{
int ch;
if (argc < 2)
usage(NULL);
while ((ch = getopt(argc, argv, "c:wnqdtv")) != -1)
switch(ch) {
case 'c':
cpuflag = strtol(optarg, NULL, 0);
break;
case 'w':
wflag = 1;
break;
case 'n':
nflag = 1;
break;
case 'q':
qflag = 1;
break;
case 'v':
verbose = 1;
break;
case 't':
tflag = 1;
break;
case 'd':
debugonly = 1;
break;
case '?':
default:
usage(NULL);
}
argc -= optind;
argv += optind;
pid = getpid();
uid = geteuid();
if (tflag)
s = open(_PATH_DEVNULL, O_WRONLY, 0);
else {
s = socket(PF_ROUTE, SOCK_RAW, 0);
#ifdef SO_RERROR
int on = 1;
if (setsockopt(s, SOL_SOCKET, SO_RERROR, &on, sizeof(on)) == -1)
warn("SO_RERROR");
#endif
}
if (s < 0)
err(EX_OSERR, "socket");
if (*argv != NULL)
switch (keyword(*argv)) {
case K_GET:
uid = 0;
case K_CHANGE:
case K_ADD:
case K_DELETE:
newroute(argc, argv);
case K_SHOW:
show(argc, argv);
return(0);
case K_MONITOR:
monitor();
case K_FLUSH:
flushroutes(argc, argv);
exit(0);
}
usage(*argv);
}
static void
flushroutes(int argc, char **argv)
{
size_t needed;
int mib[7], rlen, seqno;
int miblen;
char *buf, *next, *lim;
struct rt_msghdr *rtm;
if (uid != 0) {
errx(EX_NOPERM, "must be root to alter routing table");
}
shutdown(s, SHUT_RD);
if (argc > 1) {
argv++;
if (argc == 2 && **argv == '-')
switch (keyword(*argv + 1)) {
case K_INET:
af = AF_INET;
break;
#ifdef INET6
case K_INET6:
af = AF_INET6;
break;
#endif
case K_LINK:
af = AF_LINK;
break;
case K_MPLS:
af = AF_MPLS;
break;
default:
goto bad;
} else
bad: usage(*argv);
}
mib[0] = CTL_NET;
mib[1] = PF_ROUTE;
mib[2] = 0;
mib[3] = 0;
mib[4] = NET_RT_DUMP;
mib[5] = 0;
if (cpuflag >= 0) {
mib[6] = cpuflag;
miblen = 7;
} else {
miblen = 6;
}
if (sysctl(mib, miblen, NULL, &needed, NULL, 0) < 0)
err(EX_OSERR, "route-sysctl-estimate");
if ((buf = malloc(needed)) == NULL)
errx(EX_OSERR, "malloc failed");
if (sysctl(mib, miblen, buf, &needed, NULL, 0) < 0)
err(EX_OSERR, "route-sysctl-get");
lim = buf + needed;
if (verbose)
printf("Examining routing table from sysctl\n");
seqno = 0;
for (next = buf; next < lim; next += rtm->rtm_msglen) {
rtm = (struct rt_msghdr *)next;
if (verbose)
print_rtmsg(rtm, rtm->rtm_msglen);
if ((rtm->rtm_flags & RTF_GATEWAY) == 0)
continue;
if (af != 0) {
struct sockaddr *sa = (struct sockaddr *)(rtm + 1);
if (sa->sa_family != af)
continue;
}
if (debugonly)
continue;
rtm->rtm_type = RTM_DELETE;
rtm->rtm_seq = seqno;
rlen = write(s, next, rtm->rtm_msglen);
if (rlen < (int)rtm->rtm_msglen) {
warn("write to routing socket");
printf("got only %d for rlen\n", rlen);
break;
}
seqno++;
if (qflag)
continue;
if (verbose) {
print_rtmsg(rtm, rlen);
} else {
struct sockaddr *sa = (struct sockaddr *)(rtm + 1);
if (wflag) {
printf("%-20s ", rtm->rtm_flags & RTF_HOST ?
routename(sa) : netname(sa));
} else {
printf("%-20.20s ", rtm->rtm_flags & RTF_HOST ?
routename(sa) : netname(sa));
}
sa = (struct sockaddr *)(RT_ROUNDUP(sa->sa_len) +
(char *)sa);
if (wflag) {
printf("%-20s ", routename(sa));
} else {
printf("%-20.20s ", routename(sa));
}
printf("done\n");
}
}
}
char *
routename(struct sockaddr *sa)
{
static char line[MAXHOSTNAMELEN + 1];
static char domain[MAXHOSTNAMELEN + 1];
static int first = 1;
struct hostent *hp;
const char *cp;
if (first) {
first = 0;
if (gethostname(domain, MAXHOSTNAMELEN) == 0 &&
(cp = strchr(domain, '.'))) {
domain[MAXHOSTNAMELEN] = '\0';
strcpy(domain, cp + 1);
} else
domain[0] = 0;
}
if (sa->sa_len == 0) {
strcpy(line, "default");
return (line);
}
switch (sa->sa_family) {
case AF_INET:
{
struct in_addr in;
in = ((struct sockaddr_in *)sa)->sin_addr;
cp = NULL;
if (in.s_addr == INADDR_ANY || sa->sa_len < 4)
cp = "default";
if (cp == NULL && !nflag) {
hp = gethostbyaddr(&in, sizeof(struct in_addr),
AF_INET);
if (hp != NULL) {
char *cptr;
cptr = strchr(hp->h_name, '.');
if (cptr != NULL && !wflag &&
strcmp(cptr + 1, domain) == 0)
*cptr = '\0';
cp = hp->h_name;
}
}
if (cp != NULL) {
strncpy(line, cp, sizeof(line) - 1);
line[sizeof(line) - 1] = '\0';
} else
sprintf(line, "%s", inet_ntoa(in));
break;
}
#ifdef INET6
case AF_INET6:
{
struct sockaddr_in6 sin6;
int niflags = 0;
#ifdef NI_WITHSCOPEID
niflags = NI_WITHSCOPEID;
#endif
memset(&sin6, 0, sizeof(sin6));
memcpy(&sin6, sa, sa->sa_len);
sin6.sin6_len = sizeof(struct sockaddr_in6);
sin6.sin6_family = AF_INET6;
#ifdef __KAME__
if (sa->sa_len == sizeof(struct sockaddr_in6) &&
(IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr) ||
IN6_IS_ADDR_MC_LINKLOCAL(&sin6.sin6_addr)) &&
sin6.sin6_scope_id == 0) {
sin6.sin6_scope_id =
ntohs(*(u_int16_t *)&sin6.sin6_addr.s6_addr[2]);
sin6.sin6_addr.s6_addr[2] = 0;
sin6.sin6_addr.s6_addr[3] = 0;
}
#endif
if (nflag)
niflags |= NI_NUMERICHOST;
if (getnameinfo((struct sockaddr *)&sin6, sin6.sin6_len,
line, sizeof(line), NULL, 0, niflags) != 0)
strncpy(line, "invalid", sizeof(line));
return(line);
}
#endif
case AF_LINK:
{
struct sockaddr_dl *sdl = (struct sockaddr_dl *)sa;
if (sdl->sdl_nlen == 0 && sdl->sdl_alen == 0 &&
sdl->sdl_slen == 0) {
sprintf(line, "link#%d", sdl->sdl_index);
return (line);
}
switch (sdl->sdl_type) {
case IFT_ETHER:
case IFT_L2VLAN:
case IFT_CARP:
if (sdl->sdl_alen == ETHER_ADDR_LEN) {
return ether_ntoa((struct ether_addr *)
(sdl->sdl_data + sdl->sdl_nlen));
}
default:
return link_ntoa(sdl);
}
}
default:
{
uint8_t *sp = (uint8_t *)sa->sa_data;
uint8_t *splim = (uint8_t *)sa + sa->sa_len;
char *cps = line + sprintf(line, "(%d)", sa->sa_family);
char *cpe = line + sizeof(line);
while (sp < splim && cps < cpe)
cps += snprintf(cps, cpe - cps, "%02x.", *sp++);
cps[-1] = '\0';
break;
}
}
return (line);
}
char *
netname(struct sockaddr *sa)
{
const char *cp = NULL;
static char line[MAXHOSTNAMELEN + 1];
struct netent *np = NULL;
u_long net, mask;
u_long i;
int subnetshift;
switch (sa->sa_family) {
case AF_INET:
{ struct in_addr in;
in = ((struct sockaddr_in *)sa)->sin_addr;
i = in.s_addr = ntohl(in.s_addr);
if (in.s_addr == 0)
cp = "default";
else if (!nflag) {
if (IN_CLASSA(i)) {
mask = IN_CLASSA_NET;
subnetshift = 8;
} else if (IN_CLASSB(i)) {
mask = IN_CLASSB_NET;
subnetshift = 8;
} else {
mask = IN_CLASSC_NET;
subnetshift = 4;
}
while (in.s_addr &~ mask)
mask |= mask >> subnetshift;
net = in.s_addr & mask;
while ((mask & 1) == 0)
mask >>= 1, net >>= 1;
np = getnetbyaddr(net, AF_INET);
if (np != NULL)
cp = np->n_name;
}
#define C(x) (unsigned)((x) & 0xff)
if (cp != NULL)
strncpy(line, cp, sizeof(line));
else if ((in.s_addr & 0xffffff) == 0)
sprintf(line, "%u", C(in.s_addr >> 24));
else if ((in.s_addr & 0xffff) == 0)
sprintf(line, "%u.%u", C(in.s_addr >> 24),
C(in.s_addr >> 16));
else if ((in.s_addr & 0xff) == 0)
sprintf(line, "%u.%u.%u", C(in.s_addr >> 24),
C(in.s_addr >> 16), C(in.s_addr >> 8));
else
sprintf(line, "%u.%u.%u.%u", C(in.s_addr >> 24),
C(in.s_addr >> 16), C(in.s_addr >> 8),
C(in.s_addr));
#undef C
break;
}
#ifdef INET6
case AF_INET6:
{
struct sockaddr_in6 sin6;
int niflags = 0;
#ifdef NI_WITHSCOPEID
niflags = NI_WITHSCOPEID;
#endif
memset(&sin6, 0, sizeof(sin6));
memcpy(&sin6, sa, sa->sa_len);
sin6.sin6_len = sizeof(struct sockaddr_in6);
sin6.sin6_family = AF_INET6;
#ifdef __KAME__
if (sa->sa_len == sizeof(struct sockaddr_in6) &&
(IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr) ||
IN6_IS_ADDR_MC_LINKLOCAL(&sin6.sin6_addr)) &&
sin6.sin6_scope_id == 0) {
sin6.sin6_scope_id =
ntohs(*(u_int16_t *)&sin6.sin6_addr.s6_addr[2]);
sin6.sin6_addr.s6_addr[2] = 0;
sin6.sin6_addr.s6_addr[3] = 0;
}
#endif
if (nflag)
niflags |= NI_NUMERICHOST;
if (getnameinfo((struct sockaddr *)&sin6, sin6.sin6_len,
line, sizeof(line), NULL, 0, niflags) != 0)
strncpy(line, "invalid", sizeof(line));
return(line);
}
#endif
case AF_LINK:
return(link_ntoa((struct sockaddr_dl *)sa));
default:
{
uint8_t *sp = (uint8_t *)sa->sa_data;
uint8_t *splim = (uint8_t *)sa + sa->sa_len;
char *cps = line + sprintf(line, "af %d:", sa->sa_family);
char *cpe = line + sizeof(line);
while (sp < splim && cps < cpe)
cps += snprintf(cps, cpe - cps, " %02x", *sp++);
break;
}
}
return(line);
}
static void
set_metric(char *value, int key)
{
int flag = 0;
u_long noval, *valp = &noval;
switch (key) {
#define caseof(x, y, z) case x: valp = &rt_metrics.z; flag = y; break
caseof(K_MTU, RTV_MTU, rmx_mtu);
caseof(K_HOPCOUNT, RTV_HOPCOUNT, rmx_hopcount);
caseof(K_EXPIRE, RTV_EXPIRE, rmx_expire);
caseof(K_RECVPIPE, RTV_RPIPE, rmx_recvpipe);
caseof(K_SENDPIPE, RTV_SPIPE, rmx_sendpipe);
caseof(K_SSTHRESH, RTV_SSTHRESH, rmx_ssthresh);
caseof(K_RTT, RTV_RTT, rmx_rtt);
caseof(K_RTTVAR, RTV_RTTVAR, rmx_rttvar);
caseof(K_MSL, RTV_MSL, rmx_msl);
caseof(K_IWMAX, RTV_IWMAXSEGS, rmx_iwmaxsegs);
caseof(K_IW, RTV_IWCAPSEGS, rmx_iwcapsegs);
}
rtm_inits |= flag;
if (lockrest || locking)
rt_metrics.rmx_locks |= flag;
if (locking)
locking = 0;
*valp = atoi(value);
}
static void
newroute(int argc, char **argv)
{
char *cmd;
const char *err_str, *dest = "", *gateway = "";
int ishost = 0, proxy = 0, ret, attempts, oerrno, flags = RTF_STATIC;
int key;
struct hostent *hp = NULL;
if (uid != 0) {
errx(EX_NOPERM, "must be root to alter routing table");
}
cmd = argv[0];
if (*cmd != 'g')
shutdown(s, SHUT_RD);
while (--argc > 0) {
if (**(++argv)== '-') {
switch (key = keyword(1 + *argv)) {
case K_LINK:
af = AF_LINK;
aflen = sizeof(struct sockaddr_dl);
break;
case K_INET:
af = AF_INET;
aflen = sizeof(struct sockaddr_in);
break;
#ifdef INET6
case K_INET6:
af = AF_INET6;
aflen = sizeof(struct sockaddr_in6);
break;
#endif
case K_SA:
af = PF_ROUTE;
aflen = sizeof(union sockunion);
break;
case K_IFACE:
case K_INTERFACE:
iflag++;
break;
case K_NOSTATIC:
flags &= ~RTF_STATIC;
break;
case K_LLINFO:
flags |= RTF_LLINFO;
break;
case K_LOCK:
locking = 1;
break;
case K_LOCKREST:
lockrest = 1;
break;
case K_HOST:
forcehost++;
break;
case K_REJECT:
flags |= RTF_REJECT;
break;
case K_BLACKHOLE:
flags |= RTF_BLACKHOLE;
break;
case K_PROTO1:
flags |= RTF_PROTO1;
break;
case K_PROTO2:
flags |= RTF_PROTO2;
break;
case K_PROXY:
proxy = 1;
break;
case K_CLONING:
flags |= RTF_CLONING;
break;
case K_XRESOLVE:
flags |= RTF_XRESOLVE;
break;
case K_STATIC:
flags |= RTF_STATIC;
break;
case K_IFA:
if (--argc == 0)
usage(NULL);
getaddr(RTA_IFA, *++argv, 0);
break;
case K_IFP:
if (--argc == 0)
usage(NULL);
getaddr(RTA_IFP, *++argv, 0);
break;
case K_GENMASK:
if (--argc == 0)
usage(NULL);
getaddr(RTA_GENMASK, *++argv, 0);
break;
case K_GATEWAY:
if (--argc == 0)
usage(NULL);
getaddr(RTA_GATEWAY, *++argv, 0);
break;
case K_DST:
if (--argc == 0)
usage(NULL);
ishost = getaddr(RTA_DST, *++argv, &hp);
dest = *argv;
break;
case K_NETMASK:
if (--argc == 0)
usage(NULL);
getaddr(RTA_NETMASK, *++argv, 0);
case K_NET:
forcenet++;
break;
case K_PREFIXLEN:
if (--argc == 0)
usage(NULL);
if (prefixlen(*++argv) == -1) {
forcenet = 0;
ishost = 1;
} else {
forcenet = 1;
ishost = 0;
}
break;
case K_MPLS:
af = AF_MPLS;
aflen = sizeof(struct sockaddr_mpls);
break;
case K_POP:
flags |= RTF_MPLSOPS;
af = AF_MPLS;
mplsop = MPLSLOP_POP;
switch(++popcount){
case 1:
getaddr(RTA_MPLS1, "", 0);
break;
case 2:
getaddr(RTA_MPLS2, "", 0);
break;
case 3:
getaddr(RTA_MPLS3, "", 0);
break;
}
break;
case K_PUSH:
case K_SWAP:
if (popcount > 0) {
warnx("Push or swap after pop. Ignoring.");
break;
}
if (key == K_PUSH) {
mplsop = MPLSLOP_PUSH;
++pushcount;
} else {
if (pushcount > 0) {
warnx("Swap after push. Ignoring.");
break;
}
if (swapcount > 0) {
warnx("Too many swaps. Ignoring.");
break;
}
mplsop = MPLSLOP_SWAP;
++swapcount;
}
flags |= RTF_MPLSOPS;
af = AF_MPLS;
aflen = sizeof(struct sockaddr_mpls);
if (--argc == 0)
usage(NULL);
switch(pushcount + swapcount){
case 1:
getaddr(RTA_MPLS1, *++argv, 0);
break;
case 2:
getaddr(RTA_MPLS2, *++argv, 0);
break;
case 3:
getaddr(RTA_MPLS3, *++argv, 0);
break;
}
break;
case K_MTU:
case K_HOPCOUNT:
case K_EXPIRE:
case K_RECVPIPE:
case K_SENDPIPE:
case K_SSTHRESH:
case K_RTT:
case K_RTTVAR:
case K_MSL:
case K_IWMAX:
case K_IW:
if (--argc == 0)
usage(NULL);
set_metric(*++argv, key);
break;
default:
usage(1+*argv);
}
} else {
if ((rtm_addrs & RTA_DST) == 0) {
dest = *argv;
ishost = getaddr(RTA_DST, *argv, &hp);
} else if ((rtm_addrs & RTA_GATEWAY) == 0) {
gateway = *argv;
getaddr(RTA_GATEWAY, *argv, &hp);
} else {
getaddr(RTA_NETMASK, *argv, 0);
forcenet = 1;
}
}
}
if (forcehost) {
ishost = 1;
#ifdef INET6
if (af == AF_INET6) {
rtm_addrs &= ~RTA_NETMASK;
memset((void *)&so_mask, 0, sizeof(so_mask));
}
#endif
}
if (forcenet)
ishost = 0;
flags |= RTF_UP;
if (ishost)
flags |= RTF_HOST;
if (iflag == 0)
flags |= RTF_GATEWAY;
if (proxy) {
so_dst.sinarp.sin_other = SIN_PROXY;
flags |= RTF_ANNOUNCE;
}
for (attempts = 1; ; attempts++) {
errno = 0;
if ((ret = rtmsg(*cmd, flags)) == 0)
break;
if (errno != ENETUNREACH && errno != ESRCH)
break;
if (af == AF_INET && *gateway != '\0' &&
hp != NULL && hp->h_addr_list[1] != NULL) {
so_gate_tried = so_gate.sin;
hp->h_addr_list++;
memmove(&so_gate.sin.sin_addr,
hp->h_addr_list[0],
MIN((size_t)hp->h_length,
sizeof(so_gate.sin.sin_addr)));
} else
break;
}
if (*cmd == 'g')
exit(0);
if (!qflag) {
oerrno = errno;
printf("%s %s %s", cmd, ishost? "host" : "net", dest);
if (*gateway != '\0') {
printf(": gateway %s", gateway);
if (attempts > 1 && ret == 0 && af == AF_INET) {
printf(" (%s)",
inet_ntoa(so_gate_tried.sin_addr));
}
}
if (ret == 0) {
printf("\n");
} else {
switch (oerrno) {
case ESRCH:
err_str = "not in table";
break;
case EBUSY:
err_str = "entry in use";
break;
case ENOBUFS:
err_str = "routing table overflow";
break;
case EDQUOT:
err_str = "gateway uses the same route";
break;
default:
err_str = strerror(oerrno);
break;
}
printf(": %s\n", err_str);
}
}
exit(ret != 0);
}
static void
inet_makenetandmask(u_long net, struct sockaddr_in *in, u_long bits)
{
u_long addr, mask = 0;
char *cp;
rtm_addrs |= RTA_NETMASK;
if (net <= 0xff)
addr = net << IN_CLASSA_NSHIFT;
else if (net <= 0xffff)
addr = net << IN_CLASSB_NSHIFT;
else if (net <= 0xffffff)
addr = net << IN_CLASSC_NSHIFT;
else
addr = net;
if (bits != 0)
mask = 0xffffffff << (32 - bits);
else if (net == 0)
mask = 0;
else if (IN_CLASSA(addr))
mask = IN_CLASSA_NET;
else if (IN_CLASSB(addr))
mask = IN_CLASSB_NET;
else if (IN_CLASSC(addr))
mask = IN_CLASSC_NET;
else if (IN_MULTICAST(addr))
mask = IN_CLASSD_NET;
else
mask = 0xffffffff;
in->sin_addr.s_addr = htonl(addr);
in = &so_mask.sin;
in->sin_addr.s_addr = htonl(mask);
in->sin_len = 0;
in->sin_family = 0;
cp = (char *)(&in->sin_addr + 1);
while (*--cp == 0 && cp > (char *)in)
;
in->sin_len = 1 + cp - (char *)in;
}
#ifdef INET6
static int
inet6_makenetandmask(struct sockaddr_in6 *sin6, const char *plen)
{
struct in6_addr in6;
if (plen == NULL) {
if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr) &&
sin6->sin6_scope_id == 0) {
plen = "0";
} else if ((sin6->sin6_addr.s6_addr[0] & 0xe0) == 0x20) {
memset(&in6, 0, sizeof(in6));
if (memcmp(&sin6->sin6_addr.s6_addr[8],
&in6.s6_addr[8], 8) == 0)
plen = "64";
}
}
if (plen == NULL || strcmp(plen, "128") == 0)
return(1);
rtm_addrs |= RTA_NETMASK;
prefixlen(plen);
return(0);
}
#endif
static int
getaddr(int which, const char *str, struct hostent **hpp)
{
sup su;
struct hostent *hp;
struct netent *np;
u_long val;
char *q;
int afamily;
if (af == 0) {
af = AF_INET;
aflen = sizeof(struct sockaddr_in);
}
afamily = af;
rtm_addrs |= which;
switch (which) {
case RTA_DST:
su = &so_dst;
break;
case RTA_GATEWAY:
su = &so_gate;
if (iflag) {
struct ifaddrs *ifap, *ifa;
struct sockaddr_dl *sdl = NULL;
if (getifaddrs(&ifap))
err(1, "getifaddrs");
for (ifa = ifap; ifa != NULL; ifa = ifa->ifa_next) {
if (ifa->ifa_addr->sa_family != AF_LINK)
continue;
if (strcmp(str, ifa->ifa_name) != 0)
continue;
sdl = (struct sockaddr_dl *)ifa->ifa_addr;
}
if (sdl != NULL) {
memcpy(&su->sdl, sdl, sdl->sdl_len);
su->sdl.sdl_alen = 0;
su->sdl.sdl_slen = 0;
}
freeifaddrs(ifap);
if (sdl != NULL)
return(1);
}
break;
case RTA_NETMASK:
su = &so_mask;
break;
case RTA_GENMASK:
su = &so_genmask;
break;
case RTA_IFP:
su = &so_ifp;
afamily = AF_LINK;
break;
case RTA_IFA:
su = &so_ifa;
break;
case RTA_MPLS1:
su = &so_mpls1;
break;
case RTA_MPLS2:
su = &so_mpls2;
break;
case RTA_MPLS3:
su = &so_mpls3;
break;
default:
usage("internal error");
}
su->sa.sa_len = aflen;
su->sa.sa_family = afamily;
if (strcmp(str, "default") == 0) {
switch (which) {
case RTA_DST:
forcenet++;
getaddr(RTA_NETMASK, str, 0);
break;
case RTA_NETMASK:
case RTA_GENMASK:
break;
}
return(0);
}
switch (afamily) {
#ifdef INET6
case AF_INET6:
{
struct addrinfo hints, *res;
q = NULL;
if (which == RTA_DST && (q = strchr(str, '/')) != NULL)
*q = '\0';
memset(&hints, 0, sizeof(hints));
hints.ai_family = afamily;
hints.ai_flags = AI_NUMERICHOST;
hints.ai_socktype = SOCK_DGRAM;
if (getaddrinfo(str, "0", &hints, &res) != 0 ||
res->ai_family != AF_INET6 ||
res->ai_addrlen != sizeof(su->sin6)) {
errx(EX_NOHOST, "bad value: %s", str);
}
memcpy(&su->sin6, res->ai_addr, sizeof(su->sin6));
#ifdef __KAME__
if ((IN6_IS_ADDR_LINKLOCAL(&su->sin6.sin6_addr) ||
IN6_IS_ADDR_LINKLOCAL(&su->sin6.sin6_addr)) &&
su->sin6.sin6_scope_id) {
*(u_int16_t *)&su->sin6.sin6_addr.s6_addr[2] =
htons(su->sin6.sin6_scope_id);
su->sin6.sin6_scope_id = 0;
}
#endif
freeaddrinfo(res);
if (q != NULL)
*q++ = '/';
if (which == RTA_DST)
return(inet6_makenetandmask(&su->sin6, q));
return(0);
}
#endif
case AF_LINK:
link_addr(str, &su->sdl);
return(1);
case PF_ROUTE:
su->sa.sa_len = sizeof(*su);
sockaddr(str, &su->sa);
return(1);
case AF_MPLS:
{
mpls_label_t label;
bzero(su, sizeof(*su));
su->sa.sa_len = sizeof(*su);
su->sa.sa_family = AF_MPLS;
su->smpls.smpls_op = mplsop;
if (mplsop != MPLSLOP_POP && mplsop != MPLSLOP_POPALL &&
*str != '\0') {
if (sscanf(str, "%u", &label) != 1)
errx(EX_NOHOST, "bad address: %s", str);
su->smpls.smpls_label = htonl(label);
}
return(1);
}
case AF_INET:
default:
break;
}
if (hpp == NULL)
hpp = &hp;
*hpp = NULL;
q = strchr(str,'/');
if (q != NULL && which == RTA_DST) {
*q = '\0';
if ((val = inet_network(str)) != INADDR_NONE) {
inet_makenetandmask(
val, &su->sin, strtoul(q+1, 0, 0));
return(0);
}
*q = '/';
}
if ((which != RTA_DST || forcenet == 0) &&
inet_aton(str, &su->sin.sin_addr)) {
val = su->sin.sin_addr.s_addr;
if (which != RTA_DST ||
inet_lnaof(su->sin.sin_addr) != INADDR_ANY)
return(1);
else {
val = ntohl(val);
goto netdone;
}
}
if (which == RTA_DST && forcehost == 0 &&
((val = inet_network(str)) != INADDR_NONE ||
((np = getnetbyname(str)) != NULL && (val = np->n_net) != 0))) {
netdone:
inet_makenetandmask(val, &su->sin, 0);
return(0);
}
hp = gethostbyname(str);
if (hp != NULL) {
*hpp = hp;
su->sin.sin_family = hp->h_addrtype;
memmove((char *)&su->sin.sin_addr, hp->h_addr,
MIN((size_t)hp->h_length, sizeof(su->sin.sin_addr)));
return(1);
}
errx(EX_NOHOST, "bad address: %s", str);
}
static int
prefixlen(const char *len_str)
{
int len = atoi(len_str), q, r;
int max;
char *p;
rtm_addrs |= RTA_NETMASK;
switch (af) {
#ifdef INET6
case AF_INET6:
max = 128;
p = (char *)&so_mask.sin6.sin6_addr;
break;
#endif
case AF_INET:
max = 32;
p = (char *)&so_mask.sin.sin_addr;
break;
default:
fprintf(stderr, "prefixlen not supported in this af\n");
exit(1);
}
if (len < 0 || max < len) {
fprintf(stderr, "%s: bad value\n", len_str);
exit(1);
}
q = len >> 3;
r = len & 7;
so_mask.sa.sa_family = af;
so_mask.sa.sa_len = aflen;
memset((void *)p, 0, max / 8);
if (q > 0)
memset((void *)p, 0xff, q);
if (r > 0)
*((u_char *)p + q) = (0xff00 >> r) & 0xff;
if (len == max)
return(-1);
else
return(len);
}
static void
interfaces(void)
{
size_t needed;
int mib[6];
char *buf, *lim, *next;
struct rt_msghdr *rtm;
mib[0] = CTL_NET;
mib[1] = PF_ROUTE;
mib[2] = 0;
mib[3] = 0;
mib[4] = NET_RT_IFLIST;
mib[5] = 0;
if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0)
err(EX_OSERR, "route-sysctl-estimate");
if ((buf = malloc(needed)) == NULL)
errx(EX_OSERR, "malloc failed");
if (sysctl(mib, 6, buf, &needed, NULL, 0) < 0)
err(EX_OSERR, "actual retrieval of interface table");
lim = buf + needed;
for (next = buf; next < lim; next += rtm->rtm_msglen) {
rtm = (struct rt_msghdr *)next;
print_rtmsg(rtm, rtm->rtm_msglen);
}
}
static void
monitor(void)
{
int n, error;
char msg[2048];
time_t now;
verbose = 1;
if (debugonly) {
interfaces();
exit(0);
}
for (;;) {
n = read(s, msg, sizeof(msg));
error = errno;
now = time(NULL);
if (n == -1) {
printf("\nsocket error %d on %s %s\n",
error, ctime(&now), strerror(errno));
continue;
}
printf("\ngot message of size %d on %s", n, ctime(&now));
print_rtmsg((struct rt_msghdr *)msg, n);
}
}
struct {
struct rt_msghdr m_rtm;
char m_space[512];
} m_rtmsg;
static int
rtmsg(int cmd, int flags)
{
static int seq;
int rlen;
char *cp = m_rtmsg.m_space;
int l;
#define NEXTADDR(w, u) \
if (rtm_addrs & (w)) {\
l = RT_ROUNDUP(u.sa.sa_len); memmove(cp, &(u), l); cp += l;\
if (verbose) sodump(&(u),"u");\
}
errno = 0;
memset(&m_rtmsg, 0, sizeof(m_rtmsg));
if (cmd == 'a')
cmd = RTM_ADD;
else if (cmd == 'c')
cmd = RTM_CHANGE;
else if (cmd == 'g') {
cmd = RTM_GET;
if (so_ifp.sa.sa_family == 0) {
so_ifp.sa.sa_family = AF_LINK;
so_ifp.sa.sa_len = sizeof(struct sockaddr_dl);
rtm_addrs |= RTA_IFP;
}
} else
cmd = RTM_DELETE;
#define rtm m_rtmsg.m_rtm
rtm.rtm_type = cmd;
rtm.rtm_flags = flags;
rtm.rtm_version = RTM_VERSION;
rtm.rtm_seq = ++seq;
rtm.rtm_addrs = rtm_addrs;
rtm.rtm_rmx = rt_metrics;
rtm.rtm_inits = rtm_inits;
if (rtm_addrs & RTA_NETMASK)
mask_addr();
NEXTADDR(RTA_DST, so_dst);
NEXTADDR(RTA_GATEWAY, so_gate);
NEXTADDR(RTA_NETMASK, so_mask);
NEXTADDR(RTA_GENMASK, so_genmask);
NEXTADDR(RTA_IFP, so_ifp);
NEXTADDR(RTA_IFA, so_ifa);
NEXTADDR(RTA_MPLS1, so_mpls1);
NEXTADDR(RTA_MPLS2, so_mpls2);
NEXTADDR(RTA_MPLS3, so_mpls3);
rtm.rtm_msglen = l = cp - (char *)&m_rtmsg;
if (verbose)
print_rtmsg(&rtm, l);
if (debugonly)
return(0);
if ((rlen = write(s, (char *)&m_rtmsg, l)) < 0) {
warn("writing to routing socket");
return(-1);
}
if (cmd == RTM_GET) {
do {
l = read(s, (char *)&m_rtmsg, sizeof(m_rtmsg));
} while (l > 0 && (rtm.rtm_seq != seq || rtm.rtm_pid != pid));
if (l < 0)
warn("read from routing socket");
else
print_getmsg(&rtm, l);
}
#undef rtm
return(0);
}
static void
mask_addr(void)
{
int olen = so_mask.sa.sa_len;
char *cp1 = olen + (char *)&so_mask, *cp2;
for (so_mask.sa.sa_len = 0; cp1 > (char *)&so_mask; )
if (*--cp1 != 0) {
so_mask.sa.sa_len = 1 + cp1 - (char *)&so_mask;
break;
}
if ((rtm_addrs & RTA_DST) == 0)
return;
switch (so_dst.sa.sa_family) {
case AF_INET:
#ifdef INET6
case AF_INET6:
#endif
case 0:
return;
}
cp1 = so_mask.sa.sa_len + 1 + (char *)&so_dst;
cp2 = so_dst.sa.sa_len + 1 + (char *)&so_dst;
while (cp2 > cp1)
*--cp2 = 0;
cp2 = so_mask.sa.sa_len + 1 + (char *)&so_mask;
while (cp1 > so_dst.sa.sa_data)
*--cp1 &= *--cp2;
}
const char *msgtypes[] = {
"",
"RTM_ADD: Add Route",
"RTM_DELETE: Delete Route",
"RTM_CHANGE: Change Metrics or flags",
"RTM_GET: Report Metrics",
"RTM_LOSING: Kernel Suspects Partitioning",
"RTM_REDIRECT: Told to use different route",
"RTM_MISS: Lookup failed on this address",
"RTM_LOCK: fix specified metrics",
"0x9: unused",
"0xa: unused",
"RTM_RESOLVE: Route created by cloning",
"RTM_NEWADDR: address being added to iface",
"RTM_DELADDR: address being removed from iface",
"RTM_IFINFO: iface status change",
"RTM_NEWMADDR: new multicast group membership on iface",
"RTM_DELMADDR: multicast group membership removed from iface",
"RTM_IFANNOUNCE: interface arrival/departure",
"RTM_IEEE80211: IEEE80211 wireless event",
0,
};
char metricnames[] =
"\013iw\012iwmax\011msl\010rttvar\7rtt\6ssthresh\5sendpipe\4recvpipe\3expire"
"\2hopcount\1mtu";
char routeflags[] =
"\1UP\2GATEWAY\3HOST\4REJECT\5DYNAMIC\6MODIFIED\7DONE\010MASK_PRESENT"
"\011CLONING\012XRESOLVE\013LLINFO\014STATIC\015BLACKHOLE\016b016"
"\017PROTO2\020PROTO1\021PRCLONING\022WASCLONED\023PROTO3\024CHAINDELETE"
"\025PINNED\026LOCAL\027BROADCAST\030MULTICAST";
char ifnetflags[] =
"\1UP\2BROADCAST\3DEBUG\4LOOPBACK\5PTP\6b6\7RUNNING\010NOARP"
"\011PPROMISC\012ALLMULTI\013OACTIVE\014SIMPLEX\015LINK0\016LINK1"
"\017LINK2\020MULTICAST";
char addrnames[] =
"\1DST\2GATEWAY\3NETMASK\4GENMASK\5IFP\6IFA\7AUTHOR\010BRD"
"\011MPLS1\012MPLS2\013MPLS3";
static const char *
linkstate(struct if_msghdr *ifm)
{
static char buf[64];
switch (ifm->ifm_data.ifi_link_state) {
case LINK_STATE_UNKNOWN:
return "carrier: unknown";
case LINK_STATE_DOWN:
return "carrier: no carrier";
case LINK_STATE_UP:
return "carrier: active";
default:
(void)snprintf(buf, sizeof(buf), "carrier: 0x%lx",
ifm->ifm_data.ifi_link_state);
return buf;
}
}
static void
print_rtmsg(struct rt_msghdr *rtm, int msglen __unused)
{
struct if_msghdr *ifm;
struct ifa_msghdr *ifam;
#ifdef RTM_NEWMADDR
struct ifma_msghdr *ifmam;
#endif
struct if_announcemsghdr *ifan;
union {
struct ieee80211_join_event join;
struct ieee80211_leave_event leave;
struct ieee80211_replay_event replay;
struct ieee80211_michael_event michael;
} ev;
size_t evlen = 0;
if (verbose == 0)
return;
if (rtm->rtm_version != RTM_VERSION) {
printf("routing message version %d not understood\n",
rtm->rtm_version);
return;
}
if (msgtypes[rtm->rtm_type] != NULL)
printf("%s: ", msgtypes[rtm->rtm_type]);
else
printf("#%d: ", rtm->rtm_type);
printf("len %d, ", rtm->rtm_msglen);
switch (rtm->rtm_type) {
case RTM_IFINFO:
ifm = (struct if_msghdr *)rtm;
printf("if# %d, %s, flags:", ifm->ifm_index, linkstate(ifm));
bprintf(stdout, ifm->ifm_flags, ifnetflags);
pmsg_addrs((char *)(ifm + 1), ifm->ifm_addrs);
break;
case RTM_NEWADDR:
case RTM_DELADDR:
ifam = (struct ifa_msghdr *)rtm;
printf("metric %d, flags:", ifam->ifam_metric);
bprintf(stdout, ifam->ifam_flags, routeflags);
pmsg_addrs((char *)(ifam + 1), ifam->ifam_addrs);
break;
#ifdef RTM_NEWMADDR
case RTM_NEWMADDR:
case RTM_DELMADDR:
ifmam = (struct ifma_msghdr *)rtm;
pmsg_addrs((char *)(ifmam + 1), ifmam->ifmam_addrs);
break;
#endif
case RTM_IEEE80211:
ifan = (struct if_announcemsghdr *)rtm;
(void)printf("if# %d, what: ", ifan->ifan_index);
switch (ifan->ifan_what) {
case RTM_IEEE80211_ASSOC:
printf("associate");
break;
case RTM_IEEE80211_REASSOC:
printf("re-associate");
break;
case RTM_IEEE80211_DISASSOC:
printf("disassociate");
break;
case RTM_IEEE80211_SCAN:
printf("scan complete");
break;
case RTM_IEEE80211_JOIN:
evlen = sizeof(ev.join);
printf("join");
break;
case RTM_IEEE80211_LEAVE:
evlen = sizeof(ev.leave);
printf("leave");
break;
case RTM_IEEE80211_MICHAEL:
evlen = sizeof(ev.michael);
printf("michael");
break;
case RTM_IEEE80211_REPLAY:
evlen = sizeof(ev.replay);
printf("replay");
break;
default:
evlen = 0;
printf("#%d", ifan->ifan_what);
break;
}
if (sizeof(*ifan) + evlen > ifan->ifan_msglen) {
printf(" (truncated)\n");
break;
}
(void)memcpy(&ev, (ifan + 1), evlen);
switch (ifan->ifan_what) {
case RTM_IEEE80211_JOIN:
case RTM_IEEE80211_LEAVE:
printf(" mac %" PRIETHER,
PRIETHER_ARGS(ev.join.iev_addr));
break;
case RTM_IEEE80211_REPLAY:
case RTM_IEEE80211_MICHAEL:
printf(" src %" PRIETHER " dst %" PRIETHER
" cipher %" PRIu8 " keyix %" PRIu8,
PRIETHER_ARGS(ev.replay.iev_src),
PRIETHER_ARGS(ev.replay.iev_dst),
ev.replay.iev_cipher,
ev.replay.iev_keyix);
if (ifan->ifan_what == RTM_IEEE80211_REPLAY) {
printf(" key rsc %#" PRIx64
" frame rsc %#" PRIx64,
ev.replay.iev_keyrsc, ev.replay.iev_rsc);
}
break;
default:
break;
}
printf("\n");
break;
case RTM_IFANNOUNCE:
ifan = (struct if_announcemsghdr *)rtm;
printf("if# %d, what: ", ifan->ifan_index);
switch (ifan->ifan_what) {
case IFAN_ARRIVAL:
printf("arrival");
break;
case IFAN_DEPARTURE:
printf("departure");
break;
default:
printf("#%d", ifan->ifan_what);
break;
}
printf("\n");
break;
case RTM_ADD:
case RTM_DELETE:
case RTM_GET:
printf("pid: %ld, seq %d, errno %d, flags:",
(long)rtm->rtm_pid, rtm->rtm_seq, rtm->rtm_errno);
bprintf(stdout, rtm->rtm_flags, routeflags);
pmsg_common(rtm);
break;
}
}
static void
print_getmsg(struct rt_msghdr *rtm, int msglen)
{
struct sockaddr *dst = NULL, *gate = NULL, *mask = NULL;
struct sockaddr_dl *ifp = NULL;
struct sockaddr *sa;
char *cp;
int i;
printf(" route to: %s\n", routename(&so_dst.sa));
if (rtm->rtm_version != RTM_VERSION) {
warnx("routing message version %d not understood",
rtm->rtm_version);
return;
}
if (rtm->rtm_msglen > msglen) {
warnx("message length mismatch, in packet %d, returned %d",
rtm->rtm_msglen, msglen);
}
if (rtm->rtm_errno != 0) {
errno = rtm->rtm_errno;
warn("message indicates error %d", errno);
return;
}
cp = ((char *)(rtm + 1));
if (rtm->rtm_addrs)
for (i = 1; i != 0; i <<= 1)
if (i & rtm->rtm_addrs) {
sa = (struct sockaddr *)cp;
switch (i) {
case RTA_DST:
dst = sa;
break;
case RTA_GATEWAY:
gate = sa;
break;
case RTA_NETMASK:
mask = sa;
break;
case RTA_IFP:
if (sa->sa_family == AF_LINK &&
((struct sockaddr_dl *)sa)->sdl_nlen)
ifp = (struct sockaddr_dl *)sa;
break;
}
RT_ADVANCE(cp, sa);
}
if (dst != NULL && mask != NULL)
mask->sa_family = dst->sa_family;
if (dst != NULL)
printf("destination: %s\n", routename(dst));
if (mask != NULL) {
int savenflag = nflag;
nflag = 1;
printf(" mask: %s\n", routename(mask));
nflag = savenflag;
}
if (gate != NULL && rtm->rtm_flags & RTF_GATEWAY)
printf(" gateway: %s\n", routename(gate));
if (ifp != NULL)
printf(" interface: %.*s\n",
ifp->sdl_nlen, ifp->sdl_data);
printf(" flags: ");
bprintf(stdout, rtm->rtm_flags, routeflags);
#define lock(f) ((rtm->rtm_rmx.rmx_locks & __CONCAT(RTV_,f)) ? 'L' : ' ')
#define msec(u) (((u) + 500) / 1000)
printf("\n%s\n", "\
recvpipe sendpipe ssthresh rtt,msec rttvar hopcount mtu expire msl,msec iwmax iw");
printf("%8ld%c ", rtm->rtm_rmx.rmx_recvpipe, lock(RPIPE));
printf("%8ld%c ", rtm->rtm_rmx.rmx_sendpipe, lock(SPIPE));
printf("%8ld%c ", rtm->rtm_rmx.rmx_ssthresh, lock(SSTHRESH));
printf("%8ld%c ", msec(rtm->rtm_rmx.rmx_rtt), lock(RTT));
printf("%8ld%c ", msec(rtm->rtm_rmx.rmx_rttvar), lock(RTTVAR));
printf("%8ld%c ", rtm->rtm_rmx.rmx_hopcount, lock(HOPCOUNT));
printf("%8ld%c ", rtm->rtm_rmx.rmx_mtu, lock(MTU));
if (rtm->rtm_rmx.rmx_expire != 0) {
struct timespec sp;
clock_gettime(CLOCK_MONOTONIC, &sp);
rtm->rtm_rmx.rmx_expire -= sp.tv_sec;
}
printf("%8ld%c ", rtm->rtm_rmx.rmx_expire, lock(EXPIRE));
printf("%8ld ", rtm->rtm_rmx.rmx_msl);
printf("%5ld ", rtm->rtm_rmx.rmx_iwmaxsegs);
printf("%3ld\n", rtm->rtm_rmx.rmx_iwcapsegs);
#undef lock
#undef msec
#define RTA_IGN (RTA_DST|RTA_GATEWAY|RTA_NETMASK|RTA_IFP|RTA_IFA|RTA_BRD)
if (verbose)
pmsg_common(rtm);
else if (rtm->rtm_addrs &~ RTA_IGN) {
printf("sockaddrs: ");
bprintf(stdout, rtm->rtm_addrs, addrnames);
putchar('\n');
}
#undef RTA_IGN
}
static void
pmsg_common(struct rt_msghdr *rtm)
{
printf("\nlocks: ");
bprintf(stdout, rtm->rtm_rmx.rmx_locks, metricnames);
printf(" inits: ");
bprintf(stdout, rtm->rtm_inits, metricnames);
pmsg_addrs(((char *)(rtm + 1)), rtm->rtm_addrs);
}
static void
pmsg_addrs(char *cp, int addrs)
{
struct sockaddr *sa;
int i;
if (addrs == 0) {
putchar('\n');
return;
}
printf("\nsockaddrs: ");
bprintf(stdout, addrs, addrnames);
putchar('\n');
for (i = 0; i < RTAX_MAX; i++)
if (addrs & (1 << i)) {
sa = (struct sockaddr *)cp;
printf(" %s", routename(sa));
RT_ADVANCE(cp, sa);
}
putchar('\n');
fflush(stdout);
}
static void
bprintf(FILE *fp, int b, u_char *str)
{
int i;
int gotsome = 0;
if (b == 0)
return;
while ((i = *str++) != 0) {
if (b & (1 << (i-1))) {
if (!gotsome)
i = '<';
else
i = ',';
putc(i, fp);
gotsome = 1;
for (; (i = *str) > 32; str++)
putc(i, fp);
} else
while (*str > 32)
str++;
}
if (gotsome)
putc('>', fp);
}
int
keyword(const char *cp)
{
const struct keytab *kt = keywords;
while (kt->kt_cp != NULL && strcmp(kt->kt_cp, cp) != 0)
kt++;
return(kt->kt_i);
}
static void
sodump(sup su, const char *which)
{
switch (su->sa.sa_family) {
case AF_LINK:
printf("%s: link %s; ",
which, link_ntoa(&su->sdl));
break;
case AF_INET:
printf("%s: inet %s; ",
which, inet_ntoa(su->sin.sin_addr));
break;
}
fflush(stdout);
}
#define VIRGIN 0
#define GOTONE 1
#define GOTTWO 2
#define DIGIT (4*0)
#define END (4*1)
#define DELIM (4*2)
static void
sockaddr(const char *addr, struct sockaddr *sa)
{
char *cp = (char *)sa;
int size = sa->sa_len;
char *cplim = cp + size;
int byte = 0, state = VIRGIN, new = 0 ;
memset(cp, 0, size);
cp++;
do {
if ((*addr >= '0') && (*addr <= '9')) {
new = *addr - '0';
} else if ((*addr >= 'a') && (*addr <= 'f')) {
new = *addr - 'a' + 10;
} else if ((*addr >= 'A') && (*addr <= 'F')) {
new = *addr - 'A' + 10;
} else if (*addr == '\0')
state |= END;
else
state |= DELIM;
addr++;
switch (state ) {
case GOTTWO | DIGIT:
*cp++ = byte;
case VIRGIN | DIGIT:
state = GOTONE; byte = new; continue;
case GOTONE | DIGIT:
state = GOTTWO; byte = new + (byte << 4); continue;
default:
state = VIRGIN; *cp++ = byte; byte = 0; continue;
case GOTONE | END:
case GOTTWO | END:
*cp++ = byte;
case VIRGIN | END:
break;
}
break;
} while (cp < cplim);
sa->sa_len = cp - (char *)sa;
}
