#ifndef lint
static const char copyright[] =
"@(#) Copyright (c) 1988, 1989, 1991, 1994, 1995, 1996, 1997, 1998, 1999, 2000\n\
The Regents of the University of California. All rights reserved.\n";
#if 0
static const char rcsid[] =
"@(#)$Id: traceroute.c,v 1.2 2004/08/08 00:27:54 lindak Exp $ (LBL)";
#endif
static const char rcsid[] =
"$FreeBSD: src/contrib/traceroute/traceroute.c,v 1.26 2004/04/17 18:44:23 pb Exp $";
#endif
#include <sys/param.h>
#include <sys/file.h>
#include <sys/ioctl.h>
#ifdef HAVE_SYS_SELECT_H
#include <sys/select.h>
#endif
#include <sys/socket.h>
#ifdef HAVE_SYS_SYSCTL_H
#include <sys/sysctl.h>
#endif
#include <sys/time.h>
#include <netinet/in_systm.h>
#include <netinet/in.h>
#include <netinet/ip.h>
#include <netinet/ip_var.h>
#include <netinet/ip_icmp.h>
#include <netinet/udp.h>
#include <netinet/udp_var.h>
#include <netinet/tcp.h>
#include <netinet/tcpip.h>
#include <arpa/inet.h>
#ifdef IPSEC
#include <net/route.h>
#include <netinet6/ipsec.h>
#endif
#include <ctype.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#ifdef HAVE_MALLOC_H
#include <malloc.h>
#endif
#include <memory.h>
#include <netdb.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include "gnuc.h"
#ifdef HAVE_OS_PROTO_H
#include "os-proto.h"
#endif
#ifndef ICMP_UNREACH_FILTER_PROHIB
#define ICMP_UNREACH_FILTER_PROHIB 13
#endif
#ifndef ICMP_UNREACH_HOST_PRECEDENCE
#define ICMP_UNREACH_HOST_PRECEDENCE 14
#endif
#ifndef ICMP_UNREACH_PRECEDENCE_CUTOFF
#define ICMP_UNREACH_PRECEDENCE_CUTOFF 15
#endif
#include "findsaddr.h"
#include "ifaddrlist.h"
#include "traceroute.h"
#define NGATEWAYS ((int)((MAX_IPOPTLEN - IPOPT_MINOFF - 1) / sizeof(u_int32_t)))
#ifndef MAXHOSTNAMELEN
#define MAXHOSTNAMELEN 64
#endif
#define Fprintf (void)fprintf
#define Printf (void)printf
struct grehdr {
u_int16_t flags;
u_int16_t proto;
u_int16_t length;
u_int16_t callId;
};
#ifndef IPPROTO_GRE
#define IPPROTO_GRE 47
#endif
#define GRE_PPTP_PROTO 0x880b
struct hostinfo {
char *name;
int n;
u_int32_t *addrs;
};
struct outdata {
u_char seq;
u_char ttl;
struct timeval tv;
};
#ifndef HAVE_ICMP_NEXTMTU
struct my_pmtu {
u_short ipm_void;
u_short ipm_nextmtu;
};
#endif
u_char packet[512];
struct ip *outip;
u_char *outp;
u_int32_t gwlist[NGATEWAYS + 1];
int s;
int sndsock;
struct sockaddr whereto;
struct sockaddr wherefrom;
int packlen;
int protlen;
int minpacket;
int maxpacket = 32 * 1024;
int pmtu;
u_int pausemsecs;
char *prog;
char *source;
char *hostname;
char *device;
static const char devnull[] = "/dev/null";
int nprobes = 3;
int max_ttl;
int first_ttl = 1;
u_short ident;
u_short port;
int options;
int verbose;
int waittime = 5;
int nflag;
#ifdef CANT_HACK_IPCKSUM
int doipcksum = 0;
#else
int doipcksum = 1;
#endif
int optlen;
extern int optind;
extern int opterr;
extern char *optarg;
double deltaT(struct timeval *, struct timeval *);
void freehostinfo(struct hostinfo *);
void getaddr(u_int32_t *, char *);
struct hostinfo *gethostinfo(char *);
u_short in_cksum(u_short *, int);
char *inetname(struct in_addr);
int main(int, char **);
u_short p_cksum(struct ip *, u_short *, int);
int packet_ok(u_char *, int, struct sockaddr_in *, int);
char *pr_type(u_char);
void print(u_char *, int, struct sockaddr_in *);
#ifdef IPSEC
int setpolicy __P((int so, char *policy));
#endif
void send_probe(int, int);
struct outproto *setproto(char *);
int str2val(const char *, const char *, int, int);
void tvsub(struct timeval *, struct timeval *);
void usage(void);
int wait_for_reply(int, struct sockaddr_in *, const struct timeval *);
#ifndef HAVE_USLEEP
int usleep(u_int);
#endif
void udp_prep(struct outdata *);
int udp_check(const u_char *, int);
void tcp_prep(struct outdata *);
int tcp_check(const u_char *, int);
void gre_prep(struct outdata *);
int gre_check(const u_char *, int);
void gen_prep(struct outdata *);
int gen_check(const u_char *, int);
void icmp_prep(struct outdata *);
int icmp_check(const u_char *, int);
struct outproto {
char *name;
u_char num;
u_short hdrlen;
u_short port;
void (*prepare)(struct outdata *);
int (*check)(const u_char *, int);
};
struct outproto protos[] = {
{
"udp",
IPPROTO_UDP,
sizeof(struct udphdr),
32768 + 666,
udp_prep,
udp_check
},
{
"tcp",
IPPROTO_TCP,
sizeof(struct tcphdr),
32768 + 666,
tcp_prep,
tcp_check
},
{
"gre",
IPPROTO_GRE,
sizeof(struct grehdr),
GRE_PPTP_PROTO,
gre_prep,
gre_check
},
{
"icmp",
IPPROTO_ICMP,
sizeof(struct icmp),
0,
icmp_prep,
icmp_check
},
{
NULL,
0,
2 * sizeof(u_short),
0,
gen_prep,
gen_check
},
};
struct outproto *proto = &protos[0];
int
main(int argc, char **argv)
{
register int op, code, n;
register char *cp;
register const char *err;
register u_int32_t *ap;
register struct sockaddr_in *from = (struct sockaddr_in *)&wherefrom;
register struct sockaddr_in *to = (struct sockaddr_in *)&whereto;
register struct hostinfo *hi;
int on = 1;
register struct protoent *pe;
register int ttl, probe, i;
register int seq = 0;
int tos = 0, settos = 0;
register int lsrr = 0;
register u_short off = 0;
struct ifaddrlist *al;
char errbuf[132];
int requestPort = -1;
int sump = 0;
int sockerrno;
if (open(devnull, O_RDONLY) < 0 ||
open(devnull, O_RDONLY) < 0 ||
open(devnull, O_RDONLY) < 0) {
Fprintf(stderr, "%s: open \"%s\": %s\n",
prog, devnull, strerror(errno));
exit(1);
}
cp = "icmp";
pe = getprotobyname(cp);
if (pe) {
if ((s = socket(AF_INET, SOCK_RAW, pe->p_proto)) < 0)
sockerrno = errno;
else if ((sndsock = socket(AF_INET, SOCK_RAW, IPPROTO_RAW)) < 0)
sockerrno = errno;
}
setuid(getuid());
#ifdef IPCTL_DEFTTL
{
int mib[4] = { CTL_NET, PF_INET, IPPROTO_IP, IPCTL_DEFTTL };
size_t sz = sizeof(max_ttl);
if (sysctl(mib, 4, &max_ttl, &sz, NULL, 0) == -1) {
perror("sysctl(net.inet.ip.ttl)");
exit(1);
}
}
#else
max_ttl = 30;
#endif
if (argv[0] == NULL)
prog = "traceroute";
else if ((cp = strrchr(argv[0], '/')) != NULL)
prog = cp + 1;
else
prog = argv[0];
opterr = 0;
while ((op = getopt(argc, argv, "dFInrSvxf:g:i:M:m:P:p:q:s:t:w:z:")) != EOF)
switch (op) {
case 'd':
options |= SO_DEBUG;
break;
case 'f':
case 'M':
first_ttl = str2val(optarg, "first ttl", 1, 255);
break;
case 'F':
off = IP_DF;
break;
case 'g':
if (lsrr >= NGATEWAYS) {
Fprintf(stderr,
"%s: No more than %d gateways\n",
prog, NGATEWAYS);
exit(1);
}
getaddr(gwlist + lsrr, optarg);
++lsrr;
break;
case 'i':
device = optarg;
break;
case 'I':
proto = setproto("icmp");
break;
case 'm':
max_ttl = str2val(optarg, "max ttl", 1, 255);
break;
case 'n':
++nflag;
break;
case 'P':
proto = setproto(optarg);
break;
case 'p':
requestPort = (u_short)str2val(optarg, "port",
1, (1 << 16) - 1);
break;
case 'q':
nprobes = str2val(optarg, "nprobes", 1, -1);
break;
case 'r':
options |= SO_DONTROUTE;
break;
case 's':
source = optarg;
break;
case 'S':
sump = 1;
break;
case 't':
tos = str2val(optarg, "tos", 0, 255);
++settos;
break;
case 'v':
++verbose;
break;
case 'x':
doipcksum = (doipcksum == 0);
break;
case 'w':
waittime = str2val(optarg, "wait time",
2, 24 * 60 * 60);
break;
case 'z':
pausemsecs = str2val(optarg, "pause msecs",
0, 60 * 60 * 1000);
break;
default:
usage();
}
port = (requestPort != -1) ? requestPort : proto->port;
if (first_ttl > max_ttl) {
Fprintf(stderr,
"%s: first ttl (%d) may not be greater than max ttl (%d)\n",
prog, first_ttl, max_ttl);
exit(1);
}
if (!doipcksum)
Fprintf(stderr, "%s: Warning: ip checksums disabled\n", prog);
if (lsrr > 0)
optlen = (lsrr + 1) * sizeof(gwlist[0]);
minpacket = sizeof(*outip) + proto->hdrlen + sizeof(struct outdata) + optlen;
packlen = minpacket;
switch (argc - optind) {
case 2:
packlen = str2val(argv[optind + 1],
"packet length", minpacket, maxpacket);
case 1:
hostname = argv[optind];
hi = gethostinfo(hostname);
setsin(to, hi->addrs[0]);
if (hi->n > 1)
Fprintf(stderr,
"%s: Warning: %s has multiple addresses; using %s\n",
prog, hostname, inet_ntoa(to->sin_addr));
hostname = hi->name;
hi->name = NULL;
freehostinfo(hi);
break;
default:
usage();
}
#ifdef HAVE_SETLINEBUF
setlinebuf (stdout);
#else
setvbuf(stdout, NULL, _IOLBF, 0);
#endif
protlen = packlen - sizeof(*outip) - optlen;
outip = (struct ip *)malloc((unsigned)packlen);
if (outip == NULL) {
Fprintf(stderr, "%s: malloc: %s\n", prog, strerror(errno));
exit(1);
}
memset((char *)outip, 0, packlen);
outip->ip_v = IPVERSION;
if (settos)
outip->ip_tos = tos;
#ifdef BYTESWAP_IP_HDR
outip->ip_len = htons(packlen);
outip->ip_off = htons(off);
#else
outip->ip_len = packlen;
outip->ip_off = off;
#endif
outip->ip_p = proto->num;
outp = (u_char *)(outip + 1);
#ifdef HAVE_RAW_OPTIONS
if (lsrr > 0) {
register u_char *optlist;
optlist = outp;
outp += optlen;
gwlist[lsrr] = to->sin_addr.s_addr;
outip->ip_dst.s_addr = gwlist[0];
optlist[0] = IPOPT_NOP;
optlist[1] = IPOPT_LSRR;
i = lsrr * sizeof(gwlist[0]);
optlist[2] = i + 3;
optlist[3] = IPOPT_MINOFF;
memcpy(optlist + 4, gwlist + 1, i);
} else
#endif
outip->ip_dst = to->sin_addr;
outip->ip_hl = (outp - (u_char *)outip) >> 2;
ident = (getpid() & 0xffff) | 0x8000;
if (pe == NULL) {
Fprintf(stderr, "%s: unknown protocol %s\n", prog, cp);
exit(1);
}
if (s < 0) {
errno = sockerrno;
Fprintf(stderr, "%s: icmp socket: %s\n", prog, strerror(errno));
exit(1);
}
if (options & SO_DEBUG)
(void)setsockopt(s, SOL_SOCKET, SO_DEBUG, (char *)&on,
sizeof(on));
if (options & SO_DONTROUTE)
(void)setsockopt(s, SOL_SOCKET, SO_DONTROUTE, (char *)&on,
sizeof(on));
#if defined(IPSEC) && defined(IPSEC_POLICY_IPSEC)
if (setpolicy(s, "in bypass") < 0)
errx(1, "%s", ipsec_strerror());
if (setpolicy(s, "out bypass") < 0)
errx(1, "%s", ipsec_strerror());
#endif
if (sndsock < 0) {
errno = sockerrno;
Fprintf(stderr, "%s: raw socket: %s\n", prog, strerror(errno));
exit(1);
}
#if defined(IP_OPTIONS) && !defined(HAVE_RAW_OPTIONS)
if (lsrr > 0) {
u_char optlist[MAX_IPOPTLEN];
cp = "ip";
if ((pe = getprotobyname(cp)) == NULL) {
Fprintf(stderr, "%s: unknown protocol %s\n", prog, cp);
exit(1);
}
gwlist[lsrr] = to->sin_addr.s_addr;
++lsrr;
optlist[0] = IPOPT_NOP;
optlist[1] = IPOPT_LSRR;
i = lsrr * sizeof(gwlist[0]);
optlist[2] = i + 3;
optlist[3] = IPOPT_MINOFF;
memcpy(optlist + 4, gwlist, i);
if ((setsockopt(sndsock, pe->p_proto, IP_OPTIONS,
(char *)optlist, i + sizeof(gwlist[0]))) < 0) {
Fprintf(stderr, "%s: IP_OPTIONS: %s\n",
prog, strerror(errno));
exit(1);
}
}
#endif
#ifdef SO_SNDBUF
if (setsockopt(sndsock, SOL_SOCKET, SO_SNDBUF, (char *)&packlen,
sizeof(packlen)) < 0) {
Fprintf(stderr, "%s: SO_SNDBUF: %s\n", prog, strerror(errno));
exit(1);
}
#endif
#ifdef IP_HDRINCL
if (setsockopt(sndsock, IPPROTO_IP, IP_HDRINCL, (char *)&on,
sizeof(on)) < 0) {
Fprintf(stderr, "%s: IP_HDRINCL: %s\n", prog, strerror(errno));
exit(1);
}
#else
#ifdef IP_TOS
if (settos && setsockopt(sndsock, IPPROTO_IP, IP_TOS,
(char *)&tos, sizeof(tos)) < 0) {
Fprintf(stderr, "%s: setsockopt tos %d: %s\n",
prog, tos, strerror(errno));
exit(1);
}
#endif
#endif
if (options & SO_DEBUG)
(void)setsockopt(sndsock, SOL_SOCKET, SO_DEBUG, (char *)&on,
sizeof(on));
if (options & SO_DONTROUTE)
(void)setsockopt(sndsock, SOL_SOCKET, SO_DONTROUTE, (char *)&on,
sizeof(on));
n = ifaddrlist(&al, errbuf);
if (n < 0) {
Fprintf(stderr, "%s: ifaddrlist: %s\n", prog, errbuf);
exit(1);
}
if (n == 0) {
Fprintf(stderr,
"%s: Can't find any network interfaces\n", prog);
exit(1);
}
if (device != NULL) {
for (i = n; i > 0; --i, ++al)
if (strcmp(device, al->device) == 0)
break;
if (i <= 0) {
Fprintf(stderr, "%s: Can't find interface %.32s\n",
prog, device);
exit(1);
}
}
if (source == NULL) {
if (device != NULL)
setsin(from, al->addr);
else if ((err = findsaddr(to, from)) != NULL) {
Fprintf(stderr, "%s: findsaddr: %s\n",
prog, err);
exit(1);
}
} else {
hi = gethostinfo(source);
source = hi->name;
hi->name = NULL;
if (device != NULL) {
for (i = hi->n, ap = hi->addrs; i > 0; --i, ++ap)
if (*ap == al->addr)
break;
if (i <= 0) {
Fprintf(stderr,
"%s: %s is not on interface %.32s\n",
prog, source, device);
exit(1);
}
setsin(from, *ap);
} else {
setsin(from, hi->addrs[0]);
if (hi->n > 1)
Fprintf(stderr,
"%s: Warning: %s has multiple addresses; using %s\n",
prog, source, inet_ntoa(from->sin_addr));
}
freehostinfo(hi);
}
outip->ip_src = from->sin_addr;
if (bind(sndsock, (struct sockaddr *)from, sizeof(*from)) < 0) {
Fprintf(stderr, "%s: bind: %s\n",
prog, strerror(errno));
exit (1);
}
#if defined(IPSEC) && defined(IPSEC_POLICY_IPSEC)
if (setpolicy(sndsock, "in bypass") < 0)
errx(1, "%s", ipsec_strerror());
if (setpolicy(sndsock, "out bypass") < 0)
errx(1, "%s", ipsec_strerror());
#endif
Fprintf(stderr, "%s to %s (%s)",
prog, hostname, inet_ntoa(to->sin_addr));
if (source)
Fprintf(stderr, " from %s", source);
Fprintf(stderr, ", %d hops max, %d byte packets\n", max_ttl, packlen);
(void)fflush(stderr);
for (ttl = first_ttl; ttl <= max_ttl; ++ttl) {
u_int32_t lastaddr = 0;
int gotlastaddr = 0;
int got_there = 0;
int unreachable = 0;
int sentfirst = 0;
int loss;
Printf("%2d ", ttl);
for (probe = 0, loss = 0; probe < nprobes; ++probe) {
register int cc;
struct timeval t1, t2;
struct timezone tz;
register struct ip *ip;
struct outdata outdata;
if (sentfirst && pausemsecs > 0)
usleep(pausemsecs * 1000);
outdata.seq = ++seq;
outdata.ttl = ttl;
(void)gettimeofday(&t1, &tz);
memcpy(&outdata.tv, &t1, sizeof(outdata.tv));
(*proto->prepare)(&outdata);
send_probe(seq, ttl);
++sentfirst;
while ((cc = wait_for_reply(s, from, &t1)) != 0) {
double T;
int precis;
(void)gettimeofday(&t2, &tz);
i = packet_ok(packet, cc, from, seq);
if (i == 0)
continue;
if (!gotlastaddr ||
from->sin_addr.s_addr != lastaddr) {
print(packet, cc, from);
lastaddr = from->sin_addr.s_addr;
++gotlastaddr;
}
T = deltaT(&t1, &t2);
#ifdef SANE_PRECISION
if (T >= 1000.0)
precis = 0;
else if (T >= 100.0)
precis = 1;
else if (T >= 10.0)
precis = 2;
else
#endif
precis = 3;
Printf(" %.*f ms", precis, T);
if (i == -2) {
#ifndef ARCHAIC
ip = (struct ip *)packet;
if (ip->ip_ttl <= 1)
Printf(" !");
#endif
++got_there;
break;
}
if (i == -1)
break;
code = i - 1;
switch (code) {
case ICMP_UNREACH_PORT:
#ifndef ARCHAIC
ip = (struct ip *)packet;
if (ip->ip_ttl <= 1)
Printf(" !");
#endif
++got_there;
break;
case ICMP_UNREACH_NET:
++unreachable;
Printf(" !N");
break;
case ICMP_UNREACH_HOST:
++unreachable;
Printf(" !H");
break;
case ICMP_UNREACH_PROTOCOL:
++got_there;
Printf(" !P");
break;
case ICMP_UNREACH_NEEDFRAG:
++unreachable;
Printf(" !F-%d", pmtu);
break;
case ICMP_UNREACH_SRCFAIL:
++unreachable;
Printf(" !S");
break;
case ICMP_UNREACH_FILTER_PROHIB:
++unreachable;
Printf(" !X");
break;
case ICMP_UNREACH_HOST_PRECEDENCE:
++unreachable;
Printf(" !V");
break;
case ICMP_UNREACH_PRECEDENCE_CUTOFF:
++unreachable;
Printf(" !C");
break;
default:
++unreachable;
Printf(" !<%d>", code);
break;
}
break;
}
if (cc == 0) {
loss++;
Printf(" *");
}
(void)fflush(stdout);
}
if (sump) {
Printf(" (%d%% loss)", (loss * 100) / nprobes);
}
putchar('\n');
if (got_there ||
(unreachable > 0 && unreachable >= nprobes - 1))
break;
}
exit(0);
}
int
wait_for_reply(register int sock, register struct sockaddr_in *fromp,
register const struct timeval *tp)
{
fd_set *fdsp;
size_t nfds;
struct timeval now, wait;
struct timezone tz;
register int cc = 0;
register int error;
int fromlen = sizeof(*fromp);
nfds = howmany(sock + 1, NFDBITS);
if ((fdsp = malloc(nfds * sizeof(fd_mask))) == NULL)
err(1, "malloc");
memset(fdsp, 0, nfds * sizeof(fd_mask));
FD_SET(sock, fdsp);
wait.tv_sec = tp->tv_sec + waittime;
wait.tv_usec = tp->tv_usec;
(void)gettimeofday(&now, &tz);
tvsub(&wait, &now);
if (wait.tv_sec < 0) {
wait.tv_sec = 0;
wait.tv_usec = 1;
}
error = select(sock + 1, fdsp, NULL, NULL, &wait);
if (error == -1 && errno == EINVAL) {
Fprintf(stderr, "%s: botched select() args\n", prog);
exit(1);
}
if (error > 0)
cc = recvfrom(sock, (char *)packet, sizeof(packet), 0,
(struct sockaddr *)fromp, &fromlen);
free(fdsp);
return(cc);
}
void
send_probe(int seq, int ttl)
{
register int cc;
outip->ip_ttl = ttl;
outip->ip_id = htons(ident + seq);
if (verbose > 1) {
register const u_short *sp;
register int nshorts, i;
sp = (u_short *)outip;
nshorts = (u_int)packlen / sizeof(u_short);
i = 0;
Printf("[ %d bytes", packlen);
while (--nshorts >= 0) {
if ((i++ % 8) == 0)
Printf("\n\t");
Printf(" %04x", ntohs(*sp++));
}
if (packlen & 1) {
if ((i % 8) == 0)
Printf("\n\t");
Printf(" %02x", *(u_char *)sp);
}
Printf("]\n");
}
#if !defined(IP_HDRINCL) && defined(IP_TTL)
if (setsockopt(sndsock, IPPROTO_IP, IP_TTL,
(char *)&ttl, sizeof(ttl)) < 0) {
Fprintf(stderr, "%s: setsockopt ttl %d: %s\n",
prog, ttl, strerror(errno));
exit(1);
}
#endif
cc = sendto(sndsock, (char *)outip,
packlen, 0, &whereto, sizeof(whereto));
if (cc < 0 || cc != packlen) {
if (cc < 0)
Fprintf(stderr, "%s: sendto: %s\n",
prog, strerror(errno));
Printf("%s: wrote %s %d chars, ret=%d\n",
prog, hostname, packlen, cc);
(void)fflush(stdout);
}
}
#if defined(IPSEC) && defined(IPSEC_POLICY_IPSEC)
int
setpolicy(so, policy)
int so;
char *policy;
{
char *buf;
buf = ipsec_set_policy(policy, strlen(policy));
if (buf == NULL) {
warnx("%s", ipsec_strerror());
return -1;
}
(void)setsockopt(so, IPPROTO_IP, IP_IPSEC_POLICY,
buf, ipsec_get_policylen(buf));
free(buf);
return 0;
}
#endif
double
deltaT(struct timeval *t1p, struct timeval *t2p)
{
register double dt;
dt = (double)(t2p->tv_sec - t1p->tv_sec) * 1000.0 +
(double)(t2p->tv_usec - t1p->tv_usec) / 1000.0;
return (dt);
}
char *
pr_type(register u_char t)
{
static char *ttab[] = {
"Echo Reply", "ICMP 1", "ICMP 2", "Dest Unreachable",
"Source Quench", "Redirect", "ICMP 6", "ICMP 7",
"Echo", "ICMP 9", "ICMP 10", "Time Exceeded",
"Param Problem", "Timestamp", "Timestamp Reply", "Info Request",
"Info Reply"
};
if (t > 16)
return("OUT-OF-RANGE");
return(ttab[t]);
}
int
packet_ok(register u_char *buf, int cc, register struct sockaddr_in *from,
register int seq)
{
register struct icmp *icp;
register u_char type, code;
register int hlen;
#ifndef ARCHAIC
register struct ip *ip;
ip = (struct ip *) buf;
hlen = ip->ip_hl << 2;
if (cc < hlen + ICMP_MINLEN) {
if (verbose)
Printf("packet too short (%d bytes) from %s\n", cc,
inet_ntoa(from->sin_addr));
return (0);
}
cc -= hlen;
icp = (struct icmp *)(buf + hlen);
#else
icp = (struct icmp *)buf;
#endif
type = icp->icmp_type;
code = icp->icmp_code;
if (code != ICMP_UNREACH_NEEDFRAG)
pmtu = 0;
else {
#ifdef HAVE_ICMP_NEXTMTU
pmtu = ntohs(icp->icmp_nextmtu);
#else
pmtu = ntohs(((struct my_pmtu *)&icp->icmp_void)->ipm_nextmtu);
#endif
}
if (type == ICMP_ECHOREPLY
&& proto->num == IPPROTO_ICMP
&& (*proto->check)((u_char *)icp, (u_char)seq))
return -2;
if ((type == ICMP_TIMXCEED && code == ICMP_TIMXCEED_INTRANS) ||
type == ICMP_UNREACH) {
struct ip *hip;
u_char *inner;
hip = &icp->icmp_ip;
hlen = hip->ip_hl << 2;
inner = (u_char *)((u_char *)hip + hlen);
if (hlen + 12 <= cc
&& hip->ip_p == proto->num
&& (*proto->check)(inner, (u_char)seq))
return (type == ICMP_TIMXCEED ? -1 : code + 1);
}
#ifndef ARCHAIC
if (verbose) {
register int i;
u_int32_t *lp = (u_int32_t *)&icp->icmp_ip;
Printf("\n%d bytes from %s to ", cc, inet_ntoa(from->sin_addr));
Printf("%s: icmp type %d (%s) code %d\n",
inet_ntoa(ip->ip_dst), type, pr_type(type), icp->icmp_code);
for (i = 4; i < cc ; i += sizeof(*lp))
Printf("%2d: x%8.8x\n", i, *lp++);
}
#endif
return(0);
}
void
icmp_prep(struct outdata *outdata)
{
struct icmp *const icmpheader = (struct icmp *) outp;
icmpheader->icmp_type = ICMP_ECHO;
icmpheader->icmp_id = htons(ident);
icmpheader->icmp_seq = htons(outdata->seq);
icmpheader->icmp_cksum = 0;
icmpheader->icmp_cksum = in_cksum((u_short *)icmpheader, protlen);
if (icmpheader->icmp_cksum == 0)
icmpheader->icmp_cksum = 0xffff;
}
int
icmp_check(const u_char *data, int seq)
{
struct icmp *const icmpheader = (struct icmp *) data;
return (icmpheader->icmp_id == htons(ident)
&& icmpheader->icmp_seq == htons(seq));
}
void
udp_prep(struct outdata *outdata)
{
struct udphdr *const outudp = (struct udphdr *) outp;
outudp->uh_sport = htons(ident);
outudp->uh_dport = htons(port + outdata->seq);
outudp->uh_ulen = htons((u_short)protlen);
outudp->uh_sum = 0;
if (doipcksum) {
u_short sum = p_cksum(outip, (u_short*)outudp, protlen);
outudp->uh_sum = (sum) ? sum : 0xffff;
}
return;
}
int
udp_check(const u_char *data, int seq)
{
struct udphdr *const udp = (struct udphdr *) data;
return (ntohs(udp->uh_sport) == ident
&& ntohs(udp->uh_dport) == port + seq);
}
void
tcp_prep(struct outdata *outdata)
{
struct tcphdr *const tcp = (struct tcphdr *) outp;
tcp->th_sport = htons(ident);
tcp->th_dport = htons(port + outdata->seq);
tcp->th_seq = (tcp->th_sport << 16) | tcp->th_dport;
tcp->th_ack = 0;
tcp->th_off = 5;
tcp->th_flags = TH_SYN;
tcp->th_sum = 0;
if (doipcksum) {
u_short sum = p_cksum(outip, (u_short*)tcp, protlen);
tcp->th_sum = (sum) ? sum : 0xffff;
}
}
int
tcp_check(const u_char *data, int seq)
{
struct tcphdr *const tcp = (struct tcphdr *) data;
return (ntohs(tcp->th_sport) == ident
&& ntohs(tcp->th_dport) == port + seq);
}
void
gre_prep(struct outdata *outdata)
{
struct grehdr *const gre = (struct grehdr *) outp;
gre->flags = htons(0x2001);
gre->proto = htons(port);
gre->length = 0;
gre->callId = htons(ident + outdata->seq);
}
int
gre_check(const u_char *data, int seq)
{
struct grehdr *const gre = (struct grehdr *) data;
return(ntohs(gre->proto) == port
&& ntohs(gre->callId) == ident + seq);
}
void
gen_prep(struct outdata *outdata)
{
u_int16_t *const ptr = (u_int16_t *) outp;
ptr[0] = htons(ident);
ptr[1] = htons(port + outdata->seq);
}
int
gen_check(const u_char *data, int seq)
{
u_int16_t *const ptr = (u_int16_t *) data;
return(ntohs(ptr[0]) == ident
&& ntohs(ptr[1]) == port + seq);
}
void
print(register u_char *buf, register int cc, register struct sockaddr_in *from)
{
register struct ip *ip;
register int hlen;
ip = (struct ip *) buf;
hlen = ip->ip_hl << 2;
cc -= hlen;
if (nflag)
Printf(" %s", inet_ntoa(from->sin_addr));
else
Printf(" %s (%s)", inetname(from->sin_addr),
inet_ntoa(from->sin_addr));
if (verbose)
Printf(" %d bytes to %s", cc, inet_ntoa (ip->ip_dst));
}
u_short
p_cksum(struct ip *ip, u_short *data, int len)
{
static struct ipovly ipo;
u_short sumh, sumd;
u_long sumt;
ipo.ih_pr = ip->ip_p;
ipo.ih_len = htons(len);
ipo.ih_src = ip->ip_src;
ipo.ih_dst = ip->ip_dst;
sumh = in_cksum((u_short*)&ipo, sizeof(ipo));
sumd = in_cksum((u_short*)data, len);
sumt = (sumh << 16) | (sumd);
return ~in_cksum((u_short*)&sumt, sizeof(sumt));
}
u_short
in_cksum(register u_short *addr, register int len)
{
register int nleft = len;
register u_short *w = addr;
register u_short answer;
register int sum = 0;
while (nleft > 1) {
sum += *w++;
nleft -= 2;
}
if (nleft == 1)
sum += *(u_char *)w;
sum = (sum >> 16) + (sum & 0xffff);
sum += (sum >> 16);
answer = ~sum;
return (answer);
}
void
tvsub(register struct timeval *out, register struct timeval *in)
{
if ((out->tv_usec -= in->tv_usec) < 0) {
--out->tv_sec;
out->tv_usec += 1000000;
}
out->tv_sec -= in->tv_sec;
}
char *
inetname(struct in_addr in)
{
register char *cp;
register struct hostent *hp;
static int first = 1;
static char domain[MAXHOSTNAMELEN + 1], line[MAXHOSTNAMELEN + 1];
if (first && !nflag) {
first = 0;
if (gethostname(domain, sizeof(domain) - 1) < 0)
domain[0] = '\0';
else {
cp = strchr(domain, '.');
if (cp == NULL) {
hp = gethostbyname(domain);
if (hp != NULL)
cp = strchr(hp->h_name, '.');
}
if (cp == NULL)
domain[0] = '\0';
else {
++cp;
(void)strncpy(domain, cp, sizeof(domain) - 1);
domain[sizeof(domain) - 1] = '\0';
}
}
}
if (!nflag && in.s_addr != INADDR_ANY) {
hp = gethostbyaddr((char *)&in, sizeof(in), AF_INET);
if (hp != NULL) {
if ((cp = strchr(hp->h_name, '.')) != NULL &&
strcmp(cp + 1, domain) == 0)
*cp = '\0';
(void)strncpy(line, hp->h_name, sizeof(line) - 1);
line[sizeof(line) - 1] = '\0';
return (line);
}
}
return (inet_ntoa(in));
}
struct hostinfo *
gethostinfo(register char *hostname)
{
register int n;
register struct hostent *hp;
register struct hostinfo *hi;
register char **p;
register u_int32_t addr, *ap;
if (strlen(hostname) > 64) {
Fprintf(stderr, "%s: hostname \"%.32s...\" is too long\n",
prog, hostname);
exit(1);
}
hi = calloc(1, sizeof(*hi));
if (hi == NULL) {
Fprintf(stderr, "%s: calloc %s\n", prog, strerror(errno));
exit(1);
}
addr = inet_addr(hostname);
if ((int32_t)addr != -1) {
hi->name = strdup(hostname);
hi->n = 1;
hi->addrs = calloc(1, sizeof(hi->addrs[0]));
if (hi->addrs == NULL) {
Fprintf(stderr, "%s: calloc %s\n",
prog, strerror(errno));
exit(1);
}
hi->addrs[0] = addr;
return (hi);
}
hp = gethostbyname(hostname);
if (hp == NULL) {
Fprintf(stderr, "%s: unknown host %s\n", prog, hostname);
exit(1);
}
if (hp->h_addrtype != AF_INET || hp->h_length != 4) {
Fprintf(stderr, "%s: bad host %s\n", prog, hostname);
exit(1);
}
hi->name = strdup(hp->h_name);
for (n = 0, p = hp->h_addr_list; *p != NULL; ++n, ++p)
continue;
hi->n = n;
hi->addrs = calloc(n, sizeof(hi->addrs[0]));
if (hi->addrs == NULL) {
Fprintf(stderr, "%s: calloc %s\n", prog, strerror(errno));
exit(1);
}
for (ap = hi->addrs, p = hp->h_addr_list; *p != NULL; ++ap, ++p)
memcpy(ap, *p, sizeof(*ap));
return (hi);
}
void
freehostinfo(register struct hostinfo *hi)
{
if (hi->name != NULL) {
free(hi->name);
hi->name = NULL;
}
free((char *)hi->addrs);
free((char *)hi);
}
void
getaddr(register u_int32_t *ap, register char *hostname)
{
register struct hostinfo *hi;
hi = gethostinfo(hostname);
*ap = hi->addrs[0];
freehostinfo(hi);
}
void
setsin(register struct sockaddr_in *sin, register u_int32_t addr)
{
memset(sin, 0, sizeof(*sin));
#ifdef HAVE_SOCKADDR_SA_LEN
sin->sin_len = sizeof(*sin);
#endif
sin->sin_family = AF_INET;
sin->sin_addr.s_addr = addr;
}
int
str2val(register const char *str, register const char *what,
register int mi, register int ma)
{
register const char *cp;
register int val;
char *ep;
if (str[0] == '0' && (str[1] == 'x' || str[1] == 'X')) {
cp = str + 2;
val = (int)strtol(cp, &ep, 16);
} else
val = (int)strtol(str, &ep, 10);
if (*ep != '\0') {
Fprintf(stderr, "%s: \"%s\" bad value for %s \n",
prog, str, what);
exit(1);
}
if (val < mi && mi >= 0) {
if (mi == 0)
Fprintf(stderr, "%s: %s must be >= %d\n",
prog, what, mi);
else
Fprintf(stderr, "%s: %s must be > %d\n",
prog, what, mi - 1);
exit(1);
}
if (val > ma && ma >= 0) {
Fprintf(stderr, "%s: %s must be <= %d\n", prog, what, ma);
exit(1);
}
return (val);
}
struct outproto *
setproto(char *pname)
{
struct outproto *proto;
int i;
for (i = 0; protos[i].name != NULL; i++) {
if (strcasecmp(protos[i].name, pname) == 0) {
break;
}
}
proto = &protos[i];
if (proto->name == NULL) {
struct protoent *pe;
u_long pnum;
if ((pe = getprotobyname(pname)) != NULL)
pnum = pe->p_proto;
else
pnum = str2val(optarg, "proto number", 1, 255);
proto->num = pnum;
}
return proto;
}
void
usage(void)
{
extern char version[];
Fprintf(stderr, "Version %s\n", version);
Fprintf(stderr,
"Usage: %s [-dFInrSvx] [-g gateway] [-i iface] [-f first_ttl]\n"
"\t[-m max_ttl] [-p port] [-P proto] [-q nqueries] [-s src_addr]\n"
"\t[-t tos] [-w waittime] [-z pausemsecs] host [packetlen]\n", prog);
exit(1);
}