/*
* Copyright (c) 1989 The Regents of the University of California.
* All rights reserved.
*
* This code is derived from software contributed to Berkeley by
* Mike Muuss.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. Neither the name of the University nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*/
/*
* P I N G . C
*
* Using the InterNet Control Message Protocol (ICMP) "ECHO" facility,
* measure round-trip-delays and packet loss across network paths.
*
* Author -
* Mike Muuss
* U. S. Army Ballistic Research Laboratory
* December, 1983
*
* Status -
* Public Domain. Distribution Unlimited.
* Bugs -
* More statistics could always be gathered.
* If kernel does not support non-raw ICMP sockets,
* this program has to run SUID to ROOT or with
* net_cap_raw enabled.
*/
#include "ping.h"
#include <assert.h>
#include <netinet/ip.h>
#include <netinet/ip_icmp.h>
#include <ifaddrs.h>
#include <math.h>
#ifndef ICMP_FILTER
#define ICMP_FILTER 1
struct icmp_filter {
uint32_t data;
};
#endif
ping_func_set_st ping4_func_set = {
.send_probe = ping4_send_probe,
.receive_error_msg = ping4_receive_error_msg,
.parse_reply = ping4_parse_reply,
.install_filter = ping4_install_filter
};
#define MAXIPLEN 60
#define MAXICMPLEN 76
#define NROUTES 9 /* number of record route slots */
#define TOS_MAX 255 /* 8-bit TOS field */
static int ts_type;
static int nroute = 0;
static uint32_t route[10];
static struct sockaddr_in whereto; /* who to ping */
static int optlen = 0;
static int settos = 0; /* Set TOS, Precedence or other QOS options */
static int broadcast_pings = 0;
static void pr_options(unsigned char *cp, int hlen);
static void pr_iph(struct iphdr *ip);
static unsigned short in_cksum(const unsigned short *addr, int len, unsigned short salt);
static void pr_icmph(uint8_t type, uint8_t code, uint32_t info, struct icmphdr *icp);
static int parsetos(char *str);
static int parseflow(char *str);
static struct sockaddr_in source = { .sin_family = AF_INET };
char *device;
int pmtudisc = -1;
static void create_socket(socket_st *sock, int family, int socktype, int protocol, int requisite)
{
int do_fallback = 0;
errno = 0;
assert(sock->fd == -1);
assert(socktype == SOCK_DGRAM || socktype == SOCK_RAW);
/* Attempt to create a ping socket if requested. Attempt to create a raw
* socket otherwise or as a fallback. Well known errno values follow.
*
* 1) EACCES
*
* Kernel returns EACCES for all ping socket creation attempts when the
* user isn't allowed to use ping socket. A range of group ids is
* configured using the `net.ipv4.ping_group_range` sysctl. Fallback
* to raw socket is necessary.
*
* Kernel returns EACCES for all raw socket creation attempts when the
* process doesn't have the `CAP_NET_RAW` capability.
*
* 2) EAFNOSUPPORT
*
* Kernel returns EAFNOSUPPORT for IPv6 ping or raw socket creation
* attempts when run with IPv6 support disabled (e.g. via `ipv6.disable=1`
* kernel command-line option.
*
* https://github.com/iputils/iputils/issues/32
*
* OpenVZ 2.6.32-042stab113.11 and possibly other older kernels return
* EAFNOSUPPORT for all IPv4 ping socket creation attempts due to lack
* of support in the kernel. Fallback to raw socket is necessary.
*
* https://github.com/iputils/iputils/issues/54
*
* 3) EPROTONOSUPPORT
*
* OpenVZ 2.6.32-042stab113.11 and possibly other older kernels return
* EPROTONOSUPPORT for all IPv6 ping socket creation attempts due to lack
* of support in the kernel [1]. Debian 9.5 based container with kernel 4.10
* returns EPROTONOSUPPORT also for IPv4 [2]. Fallback to raw socket is
* necessary.
*
* [1] https://github.com/iputils/iputils/issues/54
* [2] https://github.com/iputils/iputils/issues/129
*/
if (socktype == SOCK_DGRAM)
sock->fd = socket(family, socktype, protocol);
/* Kernel doesn't support ping sockets. */
if (sock->fd == -1 && errno == EAFNOSUPPORT && family == AF_INET)
do_fallback = 1;
if (sock->fd == -1 && errno == EPROTONOSUPPORT)
do_fallback = 1;
/* User is not allowed to use ping sockets. */
if (sock->fd == -1 && errno == EACCES)
do_fallback = 1;
if (socktype == SOCK_RAW || do_fallback) {
socktype = SOCK_RAW;
sock->fd = socket(family, SOCK_RAW, protocol);
}
if (sock->fd == -1) {
/* Report error related to disabled IPv6 only when IPv6 also failed or in
* verbose mode. Report other errors always.
*/
if ((errno == EAFNOSUPPORT && socktype == AF_INET6) ||
options & F_VERBOSE || requisite)
error(0, errno, "socket");
if (requisite)
exit(2);
} else
sock->socktype = socktype;
}
static void set_socket_option(socket_st *sock, int level, int optname,
const void *optval, socklen_t olen)
{
if (sock->fd == -1)
return;
if (setsockopt(sock->fd, level, optname, optval, olen) == -1)
error(2, errno, "setsockopt");
}
/* Much like stdtod(3, but will fails if str is not valid number. */
static double ping_strtod(const char *str, const char *err_msg)
{
double num;
char *end = NULL;
if (str == NULL || *str == '\0')
goto err;
errno = 0;
#ifdef USE_IDN
setlocale(LC_ALL, "C");
#endif
num = strtod(str, &end);
#ifdef USE_IDN
setlocale(LC_ALL, "");
#endif
if (errno || str == end || (end && *end))
goto err;
switch (fpclassify(num)) {
case FP_NORMAL:
case FP_ZERO:
break;
default:
errno = ERANGE;
goto err;
}
return num;
err:
error(2, errno, "%s: %s", err_msg, str);
abort(); /* cannot be reached, above error() will exit */
return 0.0;
}
int
main(int argc, char **argv)
{
struct addrinfo hints = {
.ai_family = AF_UNSPEC,
.ai_protocol = IPPROTO_UDP,
.ai_socktype = SOCK_DGRAM,
.ai_flags = getaddrinfo_flags
};
struct addrinfo *result, *ai;
int ret_val;
int ch;
socket_st sock4 = { .fd = -1 };
socket_st sock6 = { .fd = -1 };
char *target;
atexit(close_stdout);
limit_capabilities();
#if defined(USE_IDN) || defined(ENABLE_NLS)
setlocale(LC_ALL, "");
#if defined(USE_IDN)
if (!strcmp(setlocale(LC_ALL, NULL), "C"))
hints.ai_flags &= ~ AI_CANONIDN;
#endif
#ifdef ENABLE_NLS
bindtextdomain (PACKAGE_NAME, LOCALEDIR);
textdomain (PACKAGE_NAME);
#endif
#endif
/* Support being called using `ping4` or `ping6` symlinks */
if (argv[0][strlen(argv[0]) - 1] == '4')
hints.ai_family = AF_INET;
else if (argv[0][strlen(argv[0]) - 1] == '6')
hints.ai_family = AF_INET6;
/* Parse command line options */
while ((ch = getopt(argc, argv, "h?" "4bRT:" "6F:N:" "aABc:dDfi:I:l:Lm:M:nOp:qQ:rs:S:t:UvVw:W:")) != EOF) {
switch(ch) {
/* IPv4 specific options */
case '4':
if (hints.ai_family != AF_UNSPEC)
error(2, 0, _("only one -4 or -6 option may be specified"));
hints.ai_family = AF_INET;
break;
case 'b':
broadcast_pings = 1;
break;
case 'R':
if (options & F_TIMESTAMP)
error(2, 0, _("only one of -T or -R may be used"));
options |= F_RROUTE;
break;
case 'T':
if (options & F_RROUTE)
error(2, 0, _("only one of -T or -R may be used"));
options |= F_TIMESTAMP;
if (strcmp(optarg, "tsonly") == 0)
ts_type = IPOPT_TS_TSONLY;
else if (strcmp(optarg, "tsandaddr") == 0)
ts_type = IPOPT_TS_TSANDADDR;
else if (strcmp(optarg, "tsprespec") == 0)
ts_type = IPOPT_TS_PRESPEC;
else
error(2, 0, _("invalid timestamp type: %s"), optarg);
break;
/* IPv6 specific options */
case '6':
if (hints.ai_family != AF_UNSPEC)
error(2, 0, _("only one -4 or -6 option may be specified"));
hints.ai_family = AF_INET6;
break;
case 'F':
flowlabel = parseflow(optarg);
options |= F_FLOWINFO;
break;
case 'N':
if (niquery_option_handler(optarg) < 0)
usage();
hints.ai_socktype = SOCK_RAW;
break;
/* Common options */
case 'a':
options |= F_AUDIBLE;
break;
case 'A':
options |= F_ADAPTIVE;
break;
case 'B':
options |= F_STRICTSOURCE;
break;
case 'c':
npackets = strtol_or_err(optarg, _("invalid argument"), 1, LONG_MAX);
break;
case 'd':
options |= F_SO_DEBUG;
break;
case 'D':
options |= F_PTIMEOFDAY;
break;
case 'i':
{
double optval;
optval = ping_strtod(optarg, _("bad timing interval"));
if (isgreater(optval, (double)(INT_MAX / 1000)))
error(2, 0, _("bad timing interval: %s"), optarg);
interval = (int)(optval * 1000);
options |= F_INTERVAL;
}
break;
case 'I':
/* IPv6 */
if (strchr(optarg, ':')) {
char *p, *addr = strdup(optarg);
if (!addr)
error(2, errno, _("cannot copy: %s"), optarg);
p = strchr(addr, SCOPE_DELIMITER);
if (p) {
*p = '\0';
device = optarg + (p - addr) + 1;
}
if (inet_pton(AF_INET6, addr, (char *)&source6.sin6_addr) <= 0)
error(2, 0, _("invalid source address: %s"), optarg);
options |= F_STRICTSOURCE;
free(addr);
} else if (inet_pton(AF_INET, optarg, &source.sin_addr) > 0) {
options |= F_STRICTSOURCE;
} else {
device = optarg;
}
break;
case 'l':
preload = strtol_or_err(optarg, _("invalid argument"), 1, MAX_DUP_CHK);
if (uid && preload > 3)
error(2, 0, _("cannot set preload to value greater than 3: %d"), preload);
break;
case 'L':
options |= F_NOLOOP;
break;
case 'm':
mark = strtol_or_err(optarg, _("invalid argument"), 0, INT_MAX);
options |= F_MARK;
break;
case 'M':
if (strcmp(optarg, "do") == 0)
pmtudisc = IP_PMTUDISC_DO;
else if (strcmp(optarg, "dont") == 0)
pmtudisc = IP_PMTUDISC_DONT;
else if (strcmp(optarg, "want") == 0)
pmtudisc = IP_PMTUDISC_WANT;
else
error(2, 0, _("invalid -M argument: %s"), optarg);
break;
case 'n':
options |= F_NUMERIC;
break;
case 'O':
options |= F_OUTSTANDING;
break;
case 'f':
/* avoid `getaddrinfo()` during flood */
options |= F_FLOOD | F_NUMERIC;
setbuf(stdout, (char *)NULL);
break;
case 'p':
options |= F_PINGFILLED;
fill(optarg, outpack, sizeof(outpack));
break;
case 'q':
options |= F_QUIET;
break;
case 'Q':
settos = parsetos(optarg); /* IPv4 */
tclass = settos; /* IPv6 */
break;
case 'r':
options |= F_SO_DONTROUTE;
break;
case 's':
datalen = strtol_or_err(optarg, _("invalid argument"), 0, MAXPACKET - 8);
break;
case 'S':
sndbuf = strtol_or_err(optarg, _("invalid argument"), 1, INT_MAX);
break;
case 't':
ttl = strtol_or_err(optarg, _("invalid argument"), 0, 255);
options |= F_TTL;
break;
case 'U':
options |= F_LATENCY;
break;
case 'v':
options |= F_VERBOSE;
break;
case 'V':
printf(IPUTILS_VERSION("ping"));
exit(0);
case 'w':
deadline = strtol_or_err(optarg, _("invalid argument"), 0, INT_MAX);
break;
case 'W':
{
double optval;
optval = ping_strtod(optarg, _("bad linger time"));
if (isless(optval, 0.001) || isgreater(optval, (double)(INT_MAX / 1000)))
error(2, 0, _("bad linger time: %s"), optarg);
/* lingertime will be converted to usec later */
lingertime = (int)(optval * 1000);
}
break;
default:
usage();
break;
}
}
argc -= optind;
argv += optind;
if (!argc)
error(1, EDESTADDRREQ, "usage error");
target = argv[argc - 1];
/* Create sockets */
enable_capability_raw();
if (hints.ai_family != AF_INET6)
create_socket(&sock4, AF_INET, hints.ai_socktype, IPPROTO_ICMP,
hints.ai_family == AF_INET);
if (hints.ai_family != AF_INET) {
create_socket(&sock6, AF_INET6, hints.ai_socktype, IPPROTO_ICMPV6, sock4.fd == -1);
/* This may not be needed if both protocol versions always had the same value, but
* since I don't know that, it's better to be safe than sorry. */
pmtudisc = pmtudisc == IP_PMTUDISC_DO ? IPV6_PMTUDISC_DO :
pmtudisc == IP_PMTUDISC_DONT ? IPV6_PMTUDISC_DONT :
pmtudisc == IP_PMTUDISC_WANT ? IPV6_PMTUDISC_WANT : pmtudisc;
}
disable_capability_raw();
/* Limit address family on single-protocol systems */
if (hints.ai_family == AF_UNSPEC) {
if (sock4.fd == -1)
hints.ai_family = AF_INET6;
else if (sock6.fd == -1)
hints.ai_family = AF_INET;
}
/* Set socket options */
if (settos)
set_socket_option(&sock4, IPPROTO_IP, IP_TOS, &settos, sizeof settos);
if (tclass)
set_socket_option(&sock6, IPPROTO_IPV6, IPV6_TCLASS, &tclass, sizeof tclass);
ret_val = getaddrinfo(target, NULL, &hints, &result);
if (ret_val)
error(2, 0, "%s: %s", target, gai_strerror(ret_val));
for (ai = result; ai; ai = ai->ai_next) {
switch (ai->ai_family) {
case AF_INET:
ret_val = ping4_run(argc, argv, ai, &sock4);
break;
case AF_INET6:
ret_val = ping6_run(argc, argv, ai, &sock6);
break;
default:
error(2, 0, _("unknown protocol family: %d"), ai->ai_family);
}
if (ret_val == 0)
break;
}
freeaddrinfo(result);
return ret_val;
}
int ping4_run(int argc, char **argv, struct addrinfo *ai, socket_st *sock)
{
static const struct addrinfo hints = {
.ai_family = AF_INET,
.ai_protocol = IPPROTO_UDP,
.ai_flags = getaddrinfo_flags
};
int hold, packlen;
unsigned char *packet;
char *target;
char hnamebuf[NI_MAXHOST];
unsigned char rspace[3 + 4 * NROUTES + 1]; /* record route space */
uint32_t *tmp_rspace;
if (argc > 1) {
if (options & F_RROUTE)
usage();
else if (options & F_TIMESTAMP) {
if (ts_type != IPOPT_TS_PRESPEC)
usage();
if (argc > 5)
usage();
} else {
if (argc > 10)
usage();
options |= F_SOURCEROUTE;
}
}
while (argc > 0) {
target = *argv;
memset((char *)&whereto, 0, sizeof(whereto));
whereto.sin_family = AF_INET;
if (inet_aton(target, &whereto.sin_addr) == 1) {
hostname = target;
if (argc == 1)
options |= F_NUMERIC;
} else {
struct addrinfo *result = NULL;
struct addrinfo *tmp_ai = ai;
int ret_val;
if (argc > 1 || !tmp_ai) {
ret_val = getaddrinfo(target, NULL, &hints, &result);
if (ret_val)
error(2, 0, "%s: %s", target, gai_strerror(ret_val));
tmp_ai = result;
}
memcpy(&whereto, tmp_ai->ai_addr, sizeof whereto);
memset(hnamebuf, 0, sizeof hnamebuf);
if (tmp_ai->ai_canonname)
strncpy(hnamebuf, tmp_ai->ai_canonname, sizeof hnamebuf - 1);
hostname = hnamebuf;
if (result)
freeaddrinfo(result);
}
if (argc > 1)
route[nroute++] = whereto.sin_addr.s_addr;
argc--;
argv++;
}
if (source.sin_addr.s_addr == 0) {
socklen_t alen;
struct sockaddr_in dst = whereto;
int probe_fd = socket(AF_INET, SOCK_DGRAM, 0);
if (probe_fd < 0)
error(2, errno, "socket");
if (device) {
struct ifreq ifr;
int i;
int fds[2] = {probe_fd, sock->fd};
memset(&ifr, 0, sizeof(ifr));
strncpy(ifr.ifr_name, device, IFNAMSIZ - 1);
for (i = 0; i < 2; i++) {
int fd = fds[i];
int rc;
int errno_save;
enable_capability_raw();
rc = setsockopt(fd, SOL_SOCKET, SO_BINDTODEVICE,
device, strlen(device) + 1);
errno_save = errno;
disable_capability_raw();
if (rc == -1) {
if (IN_MULTICAST(ntohl(dst.sin_addr.s_addr))) {
struct ip_mreqn imr;
if (ioctl(fd, SIOCGIFINDEX, &ifr) < 0)
error(2, 0, _("unknown iface: %s"), device);
memset(&imr, 0, sizeof(imr));
imr.imr_ifindex = ifr.ifr_ifindex;
if (setsockopt(fd, SOL_IP, IP_MULTICAST_IF,
&imr, sizeof(imr)) == -1)
error(2, errno, "IP_MULTICAST_IF");
} else
error(2, errno_save, "SO_BINDTODEVICE %s", device);
}
}
}
if (settos &&
setsockopt(probe_fd, IPPROTO_IP, IP_TOS, (char *)&settos, sizeof(int)) < 0)
error(0, errno, _("warning: QOS sockopts"));
dst.sin_port = htons(1025);
if (nroute)
dst.sin_addr.s_addr = route[0];
if (connect(probe_fd, (struct sockaddr *)&dst, sizeof(dst)) == -1) {
if (errno == EACCES) {
if (broadcast_pings == 0)
error(2, 0,
_("Do you want to ping broadcast? Then -b. If not, check your local firewall rules"));
fprintf(stderr, _("WARNING: pinging broadcast address\n"));
if (setsockopt(probe_fd, SOL_SOCKET, SO_BROADCAST,
&broadcast_pings, sizeof(broadcast_pings)) < 0)
error(2, errno, _("cannot set broadcasting"));
if (connect(probe_fd, (struct sockaddr *)&dst, sizeof(dst)) == -1)
error(2, errno, "connect");
} else
error(2, errno, "connect");
}
alen = sizeof(source);
if (getsockname(probe_fd, (struct sockaddr *)&source, &alen) == -1)
error(2, errno, "getsockname");
source.sin_port = 0;
if (device) {
struct ifaddrs *ifa0, *ifa;
int ret;
ret = getifaddrs(&ifa0);
if (ret)
error(2, errno, _("gatifaddrs failed"));
for (ifa = ifa0; ifa; ifa = ifa->ifa_next) {
if (!ifa->ifa_name || !ifa->ifa_addr ||
ifa->ifa_addr->sa_family != AF_INET)
continue;
if (!strcmp(ifa->ifa_name, device) &&
!memcmp(&((struct sockaddr_in *)ifa->ifa_addr)->sin_addr,
&source.sin_addr, sizeof(source.sin_addr)))
break;
}
if (ifa && !memcmp(&((struct sockaddr_in *)ifa->ifa_addr)->sin_addr,
&dst.sin_addr, sizeof(source.sin_addr))) {
enable_capability_raw();
setsockopt(sock->fd, SOL_SOCKET, SO_BINDTODEVICE, "", 0);
disable_capability_raw();
}
freeifaddrs(ifa0);
if (!ifa)
error(0, 0, _("Warning: source address might be selected on device other than: %s"), device);
}
close(probe_fd);
} while (0);
if (whereto.sin_addr.s_addr == 0)
whereto.sin_addr.s_addr = source.sin_addr.s_addr;
if (device) {
struct ifreq ifr;
memset(&ifr, 0, sizeof(ifr));
strncpy(ifr.ifr_name, device, IFNAMSIZ - 1);
if (ioctl(sock->fd, SIOCGIFINDEX, &ifr) < 0)
error(2, 0, _("unknown iface: %s"), device);
}
if (broadcast_pings || IN_MULTICAST(ntohl(whereto.sin_addr.s_addr))) {
if (uid) {
if (interval < 1000)
error(2, 0, _("broadcast ping with too short interval: %d"), interval);
if (pmtudisc >= 0 && pmtudisc != IP_PMTUDISC_DO)
error(2, 0, _("broadcast ping does not fragment"));
}
if (pmtudisc < 0)
pmtudisc = IP_PMTUDISC_DO;
}
if (pmtudisc >= 0) {
if (setsockopt(sock->fd, SOL_IP, IP_MTU_DISCOVER, &pmtudisc, sizeof pmtudisc) == -1)
error(2, errno, "IP_MTU_DISCOVER");
}
if ((options & F_STRICTSOURCE) &&
bind(sock->fd, (struct sockaddr *)&source, sizeof source) == -1)
error(2, errno, "bind");
if (sock->socktype == SOCK_RAW) {
struct icmp_filter filt;
filt.data = ~((1 << ICMP_SOURCE_QUENCH) |
(1 << ICMP_DEST_UNREACH) |
(1 << ICMP_TIME_EXCEEDED) |
(1 << ICMP_PARAMETERPROB) |
(1 << ICMP_REDIRECT) |
(1 << ICMP_ECHOREPLY));
if (setsockopt(sock->fd, SOL_RAW, ICMP_FILTER, &filt, sizeof filt) == -1)
error(0, errno, _("WARNING: setsockopt(ICMP_FILTER)"));
}
hold = 1;
if (setsockopt(sock->fd, SOL_IP, IP_RECVERR, &hold, sizeof hold))
error(0, 0, _("WARNING: your kernel is veeery old. No problems."));
if (sock->socktype == SOCK_DGRAM) {
if (setsockopt(sock->fd, SOL_IP, IP_RECVTTL, &hold, sizeof hold))
error(0, errno, _("WARNING: setsockopt(IP_RECVTTL)"));
if (setsockopt(sock->fd, SOL_IP, IP_RETOPTS, &hold, sizeof hold))
error(0, errno, _("WARNING: setsockopt(IP_RETOPTS)"));
}
/* record route option */
if (options & F_RROUTE) {
memset(rspace, 0, sizeof(rspace));
rspace[0] = IPOPT_NOP;
rspace[1 + IPOPT_OPTVAL] = IPOPT_RR;
rspace[1 + IPOPT_OLEN] = sizeof(rspace) - 1;
rspace[1 + IPOPT_OFFSET] = IPOPT_MINOFF;
optlen = 40;
if (setsockopt(sock->fd, IPPROTO_IP, IP_OPTIONS, rspace, sizeof rspace) < 0)
error(2, errno, "record route");
}
if (options & F_TIMESTAMP) {
memset(rspace, 0, sizeof(rspace));
rspace[0] = IPOPT_TIMESTAMP;
rspace[1] = (ts_type == IPOPT_TS_TSONLY ? 40 : 36);
rspace[2] = 5;
rspace[3] = ts_type;
if (ts_type == IPOPT_TS_PRESPEC) {
int i;
rspace[1] = 4 + nroute * 8;
for (i = 0; i < nroute; i++) {
tmp_rspace = (uint32_t *)&rspace[4 + i * 8];
*tmp_rspace = route[i];
}
}
if (setsockopt(sock->fd, IPPROTO_IP, IP_OPTIONS, rspace, rspace[1]) < 0) {
rspace[3] = 2;
if (setsockopt(sock->fd, IPPROTO_IP, IP_OPTIONS, rspace, rspace[1]) < 0)
error(2, errno, "ts option");
}
optlen = 40;
}
if (options & F_SOURCEROUTE) {
int i;
memset(rspace, 0, sizeof(rspace));
rspace[0] = IPOPT_NOOP;
rspace[1 + IPOPT_OPTVAL] = (options & F_SO_DONTROUTE) ? IPOPT_SSRR : IPOPT_LSRR;
rspace[1 + IPOPT_OLEN] = 3 + nroute * 4;
rspace[1 + IPOPT_OFFSET] = IPOPT_MINOFF;
for (i = 0; i < nroute; i++) {
tmp_rspace = (uint32_t *)&rspace[4 + i * 4];
*tmp_rspace = route[i];
}
if (setsockopt(sock->fd, IPPROTO_IP, IP_OPTIONS, rspace, 4 + nroute * 4) < 0)
error(2, errno, "record route");
optlen = 40;
}
/* Estimate memory eaten by single packet. It is rough estimate.
* Actually, for small datalen's it depends on kernel side a lot. */
hold = datalen + 8;
hold += ((hold + 511) / 512) * (optlen + 20 + 16 + 64 + 160);
sock_setbufs(sock, hold);
if (broadcast_pings) {
if (setsockopt(sock->fd, SOL_SOCKET, SO_BROADCAST, &broadcast_pings,
sizeof broadcast_pings) < 0)
error(2, errno, _("cannot set broadcasting"));
}
if (options & F_NOLOOP) {
int loop = 0;
if (setsockopt(sock->fd, IPPROTO_IP, IP_MULTICAST_LOOP, &loop, sizeof loop) == -1)
error(2, errno, _("cannot disable multicast loopback"));
}
if (options & F_TTL) {
int ittl = ttl;
if (setsockopt(sock->fd, IPPROTO_IP, IP_MULTICAST_TTL, &ttl, sizeof ttl) == -1)
error(2, errno, _("cannot set multicast time-to-live"));
if (setsockopt(sock->fd, IPPROTO_IP, IP_TTL, &ittl, sizeof ittl) == -1)
error(2, errno, _("cannot set unicast time-to-live"));
}
if (datalen > 0xFFFF - 8 - optlen - 20)
error(2, 0, _("packet size %d is too large. Maximum is %d"),
datalen, 0xFFFF - 8 - 20 - optlen);
if (datalen >= (int)sizeof(struct timeval)) /* can we time transfer */
timing = 1;
packlen = datalen + MAXIPLEN + MAXICMPLEN;
if (!(packet = (unsigned char *)malloc((unsigned int)packlen)))
error(2, errno, _("memory allocation failed"));
printf(_("PING %s (%s) "), hostname, inet_ntoa(whereto.sin_addr));
if (device || (options & F_STRICTSOURCE))
printf(_("from %s %s: "), inet_ntoa(source.sin_addr), device ? device : "");
printf(_("%d(%d) bytes of data.\n"), datalen, datalen + 8 + optlen + 20);
setup(sock);
main_loop(&ping4_func_set, sock, packet, packlen);
}
int ping4_receive_error_msg(socket_st *sock)
{
ssize_t res;
char cbuf[512];
struct iovec iov;
struct msghdr msg;
struct cmsghdr *cmsgh;
struct sock_extended_err *e;
struct icmphdr icmph;
struct sockaddr_in target;
int net_errors = 0;
int local_errors = 0;
int saved_errno = errno;
iov.iov_base = &icmph;
iov.iov_len = sizeof(icmph);
msg.msg_name = (void *)⌖
msg.msg_namelen = sizeof(target);
msg.msg_iov = &iov;
msg.msg_iovlen = 1;
msg.msg_flags = 0;
msg.msg_control = cbuf;
msg.msg_controllen = sizeof(cbuf);
res = recvmsg(sock->fd, &msg, MSG_ERRQUEUE | MSG_DONTWAIT);
if (res < 0)
goto out;
e = NULL;
for (cmsgh = CMSG_FIRSTHDR(&msg); cmsgh; cmsgh = CMSG_NXTHDR(&msg, cmsgh)) {
if (cmsgh->cmsg_level == SOL_IP) {
if (cmsgh->cmsg_type == IP_RECVERR)
e = (struct sock_extended_err *)CMSG_DATA(cmsgh);
}
}
if (e == NULL)
abort();
if (e->ee_origin == SO_EE_ORIGIN_LOCAL) {
local_errors++;
if (options & F_QUIET)
goto out;
if (options & F_FLOOD)
write_stdout("E", 1);
else if (e->ee_errno != EMSGSIZE)
error(0, 0, _("local error: %s"), strerror(e->ee_errno));
else
error(0, 0, _("local error: message too long, mtu=%u"), e->ee_info);
nerrors++;
} else if (e->ee_origin == SO_EE_ORIGIN_ICMP) {
struct sockaddr_in *sin = (struct sockaddr_in *)(e + 1);
if (res < (ssize_t) sizeof(icmph) ||
target.sin_addr.s_addr != whereto.sin_addr.s_addr ||
icmph.type != ICMP_ECHO ||
!is_ours(sock, icmph.un.echo.id)) {
/* Not our error, not an error at all. Clear. */
saved_errno = 0;
goto out;
}
acknowledge(ntohs(icmph.un.echo.sequence));
if (sock->socktype == SOCK_RAW) {
struct icmp_filter filt;
filt.data = ~((1 << ICMP_SOURCE_QUENCH) |
(1 << ICMP_REDIRECT) |
(1 << ICMP_ECHOREPLY));
if (setsockopt(sock->fd, SOL_RAW, ICMP_FILTER, (const void *)&filt,
sizeof(filt)) == -1)
error(2, errno, "setsockopt(ICMP_FILTER)");
}
net_errors++;
nerrors++;
if (options & F_QUIET)
goto out;
if (options & F_FLOOD) {
write_stdout("\bE", 2);
} else {
print_timestamp();
printf(_("From %s icmp_seq=%u "), pr_addr(sin, sizeof *sin), ntohs(icmph.un.echo.sequence));
pr_icmph(e->ee_type, e->ee_code, e->ee_info, NULL);
fflush(stdout);
}
}
out:
errno = saved_errno;
return net_errors ? net_errors : -local_errors;
}
/*
* pinger --
* Compose and transmit an ICMP ECHO REQUEST packet. The IP packet
* will be added on by the kernel. The ID field is our UNIX process ID,
* and the sequence number is an ascending integer. The first several bytes
* of the data portion are used to hold a UNIX "timeval" struct in VAX
* byte-order, to compute the round-trip time.
*/
int ping4_send_probe(socket_st *sock, void *packet, unsigned packet_size __attribute__((__unused__)))
{
struct icmphdr *icp;
int cc;
int i;
icp = (struct icmphdr *)packet;
icp->type = ICMP_ECHO;
icp->code = 0;
icp->checksum = 0;
icp->un.echo.sequence = htons(ntransmitted + 1);
icp->un.echo.id = ident; /* ID */
rcvd_clear(ntransmitted + 1);
if (timing) {
if (options & F_LATENCY) {
struct timeval tmp_tv;
gettimeofday(&tmp_tv, NULL);
memcpy(icp + 1, &tmp_tv, sizeof(tmp_tv));
} else {
memset(icp + 1, 0, sizeof(struct timeval));
}
}
cc = datalen + 8; /* skips ICMP portion */
/* compute ICMP checksum here */
icp->checksum = in_cksum((unsigned short *)icp, cc, 0);
if (timing && !(options & F_LATENCY)) {
struct timeval tmp_tv;
gettimeofday(&tmp_tv, NULL);
memcpy(icp + 1, &tmp_tv, sizeof(tmp_tv));
icp->checksum = in_cksum((unsigned short *)&tmp_tv, sizeof(tmp_tv), ~icp->checksum);
}
i = sendto(sock->fd, icp, cc, 0, (struct sockaddr *)&whereto, sizeof(whereto));
return (cc == i ? 0 : i);
}
/*
* parse_reply --
* Print out the packet, if it came from us. This logic is necessary
* because ALL readers of the ICMP socket get a copy of ALL ICMP packets
* which arrive ('tis only fair). This permits multiple copies of this
* program to be run without having intermingled output (or statistics!).
*/
static
void pr_echo_reply(uint8_t *_icp, int len __attribute__((__unused__)))
{
struct icmphdr *icp = (struct icmphdr *)_icp;
printf(_(" icmp_seq=%u"), ntohs(icp->un.echo.sequence));
}
int
ping4_parse_reply(struct socket_st *sock, struct msghdr *msg, int cc, void *addr, struct timeval *tv)
{
struct sockaddr_in *from = addr;
uint8_t *buf = msg->msg_iov->iov_base;
struct icmphdr *icp;
struct iphdr *ip;
int hlen;
int csfailed;
struct cmsghdr *cmsgh;
int reply_ttl;
uint8_t *opts, *tmp_ttl;
int olen;
/* Check the IP header */
ip = (struct iphdr *)buf;
if (sock->socktype == SOCK_RAW) {
hlen = ip->ihl * 4;
if (cc < hlen + 8 || ip->ihl < 5) {
if (options & F_VERBOSE)
error(0, 0, _("packet too short (%d bytes) from %s"), cc,
pr_addr(from, sizeof *from));
return 1;
}
reply_ttl = ip->ttl;
opts = buf + sizeof(struct iphdr);
olen = hlen - sizeof(struct iphdr);
} else {
hlen = 0;
reply_ttl = 0;
opts = buf;
olen = 0;
for (cmsgh = CMSG_FIRSTHDR(msg); cmsgh; cmsgh = CMSG_NXTHDR(msg, cmsgh)) {
if (cmsgh->cmsg_level != SOL_IP)
continue;
if (cmsgh->cmsg_type == IP_TTL) {
if (cmsgh->cmsg_len < sizeof(int))
continue;
tmp_ttl = (uint8_t *)CMSG_DATA(cmsgh);
reply_ttl = (int)*tmp_ttl;
} else if (cmsgh->cmsg_type == IP_RETOPTS) {
opts = (uint8_t *)CMSG_DATA(cmsgh);
olen = cmsgh->cmsg_len;
}
}
}
/* Now the ICMP part */
cc -= hlen;
icp = (struct icmphdr *)(buf + hlen);
csfailed = in_cksum((unsigned short *)icp, cc, 0);
if (icp->type == ICMP_ECHOREPLY) {
if (!is_ours(sock, icp->un.echo.id))
return 1; /* 'Twas not our ECHO */
if (!contains_pattern_in_payload((uint8_t *)(icp + 1)))
return 1; /* 'Twas really not our ECHO */
if (gather_statistics((uint8_t *)icp, sizeof(*icp), cc,
ntohs(icp->un.echo.sequence),
reply_ttl, 0, tv, pr_addr(from, sizeof *from),
pr_echo_reply)) {
fflush(stdout);
return 0;
}
} else {
/* We fall here when a redirect or source quench arrived. */
switch (icp->type) {
case ICMP_ECHO:
/* MUST NOT */
return 1;
case ICMP_SOURCE_QUENCH:
case ICMP_REDIRECT:
case ICMP_DEST_UNREACH:
case ICMP_TIME_EXCEEDED:
case ICMP_PARAMETERPROB:
{
struct iphdr *iph = (struct iphdr *)(&icp[1]);
struct icmphdr *icp1 = (struct icmphdr *)
((unsigned char *)iph + iph->ihl * 4);
int error_pkt;
if (cc < (int)(8 + sizeof(struct iphdr) + 8) ||
cc < 8 + iph->ihl * 4 + 8)
return 1;
if (icp1->type != ICMP_ECHO ||
iph->daddr != whereto.sin_addr.s_addr ||
!is_ours(sock, icp1->un.echo.id))
return 1;
error_pkt = (icp->type != ICMP_REDIRECT &&
icp->type != ICMP_SOURCE_QUENCH);
if (error_pkt) {
acknowledge(ntohs(icp1->un.echo.sequence));
return 0;
}
if (options & (F_QUIET | F_FLOOD))
return 1;
print_timestamp();
printf(_("From %s: icmp_seq=%u "), pr_addr(from, sizeof *from),
ntohs(icp1->un.echo.sequence));
if (csfailed)
printf(_("(BAD CHECKSUM)"));
pr_icmph(icp->type, icp->code, ntohl(icp->un.gateway), icp);
return 1;
}
default:
/* MUST NOT */
break;
}
if ((options & F_FLOOD) && !(options & (F_VERBOSE | F_QUIET))) {
if (!csfailed)
write_stdout("!E", 2);
else
write_stdout("!EC", 3);
return 0;
}
if (!(options & F_VERBOSE) || uid)
return 0;
if (options & F_PTIMEOFDAY) {
struct timeval recv_time;
gettimeofday(&recv_time, NULL);
printf("%lu.%06lu ", (unsigned long)recv_time.tv_sec, (unsigned long)recv_time.tv_usec);
}
printf(_("From %s: "), pr_addr(from, sizeof *from));
if (csfailed) {
printf(_("(BAD CHECKSUM)\n"));
return 0;
}
pr_icmph(icp->type, icp->code, ntohl(icp->un.gateway), icp);
return 0;
}
if (options & F_AUDIBLE) {
putchar('\a');
if (options & F_FLOOD)
fflush(stdout);
}
if (!(options & F_FLOOD)) {
pr_options(opts, olen + sizeof(struct iphdr));
putchar('\n');
fflush(stdout);
}
return 0;
}
#if BYTE_ORDER == LITTLE_ENDIAN
# define ODDBYTE(v) (v)
#elif BYTE_ORDER == BIG_ENDIAN
# define ODDBYTE(v) ((unsigned short)(v) << 8)
#else
# define ODDBYTE(v) htons((unsigned short)(v) << 8)
#endif
unsigned short
in_cksum(const unsigned short *addr, int len, unsigned short csum)
{
int nleft = len;
const unsigned short *w = addr;
unsigned short answer;
int sum = csum;
/*
* Our algorithm is simple, using a 32 bit accumulator (sum),
* we add sequential 16 bit words to it, and at the end, fold
* back all the carry bits from the top 16 bits into the lower
* 16 bits.
*/
while (nleft > 1) {
sum += *w++;
nleft -= 2;
}
/* mop up an odd byte, if necessary */
if (nleft == 1)
sum += ODDBYTE(*(unsigned char *)w); /* le16toh() may be unavailable on old systems */
/*
* add back carry outs from top 16 bits to low 16 bits
*/
sum = (sum >> 16) + (sum & 0xffff); /* add hi 16 to low 16 */
sum += (sum >> 16); /* add carry */
answer = ~sum; /* truncate to 16 bits */
return (answer);
}
/*
* pr_icmph --
* Print a descriptive string about an ICMP header.
*/
void pr_icmph(uint8_t type, uint8_t code, uint32_t info, struct icmphdr *icp)
{
switch (type) {
case ICMP_ECHOREPLY:
printf(_("Echo Reply\n"));
/* XXX ID + Seq + Data */
break;
case ICMP_DEST_UNREACH:
switch (code) {
case ICMP_NET_UNREACH:
printf(_("Destination Net Unreachable\n"));
break;
case ICMP_HOST_UNREACH:
printf(_("Destination Host Unreachable\n"));
break;
case ICMP_PROT_UNREACH:
printf(_("Destination Protocol Unreachable\n"));
break;
case ICMP_PORT_UNREACH:
printf(_("Destination Port Unreachable\n"));
break;
case ICMP_FRAG_NEEDED:
printf(_("Frag needed and DF set (mtu = %u)\n"), info);
break;
case ICMP_SR_FAILED:
printf(_("Source Route Failed\n"));
break;
case ICMP_NET_UNKNOWN:
printf(_("Destination Net Unknown\n"));
break;
case ICMP_HOST_UNKNOWN:
printf(_("Destination Host Unknown\n"));
break;
case ICMP_HOST_ISOLATED:
printf(_("Source Host Isolated\n"));
break;
case ICMP_NET_ANO:
printf(_("Destination Net Prohibited\n"));
break;
case ICMP_HOST_ANO:
printf(_("Destination Host Prohibited\n"));
break;
case ICMP_NET_UNR_TOS:
printf(_("Destination Net Unreachable for Type of Service\n"));
break;
case ICMP_HOST_UNR_TOS:
printf(_("Destination Host Unreachable for Type of Service\n"));
break;
case ICMP_PKT_FILTERED:
printf(_("Packet filtered\n"));
break;
case ICMP_PREC_VIOLATION:
printf(_("Precedence Violation\n"));
break;
case ICMP_PREC_CUTOFF:
printf(_("Precedence Cutoff\n"));
break;
default:
printf(_("Dest Unreachable, Bad Code: %d\n"), code);
break;
}
if (icp && (options & F_VERBOSE))
pr_iph((struct iphdr *)(icp + 1));
break;
case ICMP_SOURCE_QUENCH:
printf(_("Source Quench\n"));
if (icp && (options & F_VERBOSE))
pr_iph((struct iphdr *)(icp + 1));
break;
case ICMP_REDIRECT:
switch (code) {
case ICMP_REDIR_NET:
printf(_("Redirect Network"));
break;
case ICMP_REDIR_HOST:
printf(_("Redirect Host"));
break;
case ICMP_REDIR_NETTOS:
printf(_("Redirect Type of Service and Network"));
break;
case ICMP_REDIR_HOSTTOS:
printf(_("Redirect Type of Service and Host"));
break;
default:
printf(_("Redirect, Bad Code: %d"), code);
break;
}
{
struct sockaddr_in sin = {
.sin_family = AF_INET,
.sin_addr = {
icp ? icp->un.gateway : info
}
};
printf(_("(New nexthop: %s)\n"), pr_addr(&sin, sizeof sin));
}
if (icp && (options & F_VERBOSE))
pr_iph((struct iphdr *)(icp + 1));
break;
case ICMP_ECHO:
printf(_("Echo Request\n"));
/* XXX ID + Seq + Data */
break;
case ICMP_TIME_EXCEEDED:
switch(code) {
case ICMP_EXC_TTL:
printf(_("Time to live exceeded\n"));
break;
case ICMP_EXC_FRAGTIME:
printf(_("Frag reassembly time exceeded\n"));
break;
default:
printf(_("Time exceeded, Bad Code: %d\n"), code);
break;
}
if (icp && (options & F_VERBOSE))
pr_iph((struct iphdr *)(icp + 1));
break;
case ICMP_PARAMETERPROB:
printf(_("Parameter problem: pointer = %u\n"),
icp ? (ntohl(icp->un.gateway) >> 24) : info);
if (icp && (options & F_VERBOSE))
pr_iph((struct iphdr *)(icp + 1));
break;
case ICMP_TIMESTAMP:
printf(_("Timestamp\n"));
/* XXX ID + Seq + 3 timestamps */
break;
case ICMP_TIMESTAMPREPLY:
printf(_("Timestamp Reply\n"));
/* XXX ID + Seq + 3 timestamps */
break;
case ICMP_INFO_REQUEST:
printf(_("Information Request\n"));
/* XXX ID + Seq */
break;
case ICMP_INFO_REPLY:
printf(_("Information Reply\n"));
/* XXX ID + Seq */
break;
#ifdef ICMP_MASKREQ
case ICMP_MASKREQ:
printf(_("Address Mask Request\n"));
break;
#endif
#ifdef ICMP_MASKREPLY
case ICMP_MASKREPLY:
printf(_("Address Mask Reply\n"));
break;
#endif
default:
printf(_("Bad ICMP type: %d\n"), type);
}
}
void pr_options(unsigned char *cp, int hlen)
{
int i, j;
int olen, totlen;
unsigned char *optptr;
static int old_rrlen;
static char old_rr[MAX_IPOPTLEN];
totlen = hlen - sizeof(struct iphdr);
optptr = cp;
while (totlen > 0) {
if (*optptr == IPOPT_EOL)
break;
if (*optptr == IPOPT_NOP) {
totlen--;
optptr++;
printf(_("\nNOP"));
continue;
}
cp = optptr;
olen = optptr[1];
if (olen < 2 || olen > totlen)
break;
switch (*cp) {
case IPOPT_SSRR:
case IPOPT_LSRR:
printf(_("\n%cSRR: "), *cp == IPOPT_SSRR ? 'S' : 'L');
j = *++cp;
cp++;
if (j > IPOPT_MINOFF) {
for (;;) {
uint32_t address;
memcpy(&address, cp, 4);
cp += 4;
if (address == 0)
printf("\t0.0.0.0");
else {
struct sockaddr_in sin = {
.sin_family = AF_INET,
.sin_addr = {
address
}
};
printf("\t%s", pr_addr(&sin, sizeof sin));
}
j -= 4;
putchar('\n');
if (j <= IPOPT_MINOFF)
break;
}
}
break;
case IPOPT_RR:
j = *++cp; /* get length */
i = *++cp; /* and pointer */
if (i > j)
i = j;
i -= IPOPT_MINOFF;
if (i <= 0)
break;
if (i == old_rrlen
&& !memcmp(cp, old_rr, i)
&& !(options & F_FLOOD)) {
printf(_("\t(same route)"));
break;
}
old_rrlen = i;
memcpy(old_rr, (char *)cp, i);
printf(_("\nRR: "));
cp++;
for (;;) {
uint32_t address;
memcpy(&address, cp, 4);
cp += 4;
if (address == 0)
printf("\t0.0.0.0");
else {
struct sockaddr_in sin = {
.sin_family = AF_INET,
.sin_addr = {
address
}
};
printf("\t%s", pr_addr(&sin, sizeof sin));
}
i -= 4;
putchar('\n');
if (i <= 0)
break;
}
break;
case IPOPT_TS:
{
int stdtime = 0, nonstdtime = 0;
uint8_t flags;
j = *++cp; /* get length */
i = *++cp; /* and pointer */
if (i > j)
i = j;
i -= 5;
if (i <= 0)
break;
flags = *++cp;
printf(_("\nTS: "));
cp++;
for (;;) {
long l;
if ((flags & 0xF) != IPOPT_TS_TSONLY) {
uint32_t address;
memcpy(&address, cp, 4);
cp += 4;
if (address == 0)
printf("\t0.0.0.0");
else {
struct sockaddr_in sin = {
.sin_family = AF_INET,
.sin_addr = {
address
}
};
printf("\t%s", pr_addr(&sin, sizeof sin));
}
i -= 4;
if (i <= 0)
break;
}
l = *cp++;
l = (l << 8) + *cp++;
l = (l << 8) + *cp++;
l = (l << 8) + *cp++;
if (l & 0x80000000) {
if (nonstdtime == 0)
printf(_("\t%ld absolute not-standard"), l & 0x7fffffff);
else
printf(_("\t%ld not-standard"), (l & 0x7fffffff) - nonstdtime);
nonstdtime = l & 0x7fffffff;
} else {
if (stdtime == 0)
printf(_("\t%ld absolute"), l);
else
printf("\t%ld", l - stdtime);
stdtime = l;
}
i -= 4;
putchar('\n');
if (i <= 0)
break;
}
if (flags >> 4)
printf(_("Unrecorded hops: %d\n"), flags >> 4);
break;
}
default:
printf(_("\nunknown option %x"), *cp);
break;
}
totlen -= olen;
optptr += olen;
}
}
/*
* pr_iph --
* Print an IP header with options.
*/
void pr_iph(struct iphdr *ip)
{
int hlen;
unsigned char *cp;
hlen = ip->ihl << 2;
cp = (unsigned char *)ip + 20; /* point to options */
printf(_("Vr HL TOS Len ID Flg off TTL Pro cks Src Dst Data\n"));
printf(_(" %1x %1x %02x %04x %04x"),
ip->version, ip->ihl, ip->tos, ip->tot_len, ip->id);
printf(_(" %1x %04x"), ((ip->frag_off) & 0xe000) >> 13,
(ip->frag_off) & 0x1fff);
printf(_(" %02x %02x %04x"), ip->ttl, ip->protocol, ip->check);
printf(" %s ", inet_ntoa(*(struct in_addr *)&ip->saddr));
printf(" %s ", inet_ntoa(*(struct in_addr *)&ip->daddr));
printf("\n");
pr_options(cp, hlen);
}
/*
* pr_addr --
*
* Return an ascii host address optionally with a hostname.
*/
char *
pr_addr(void *sa, socklen_t salen)
{
static char buffer[4096] = "";
static struct sockaddr_storage last_sa = { 0, {0}, 0 };
static socklen_t last_salen = 0;
char name[NI_MAXHOST] = "";
char address[NI_MAXHOST] = "";
if (salen == last_salen && !memcmp(sa, &last_sa, salen))
return buffer;
memcpy(&last_sa, sa, (last_salen = salen));
in_pr_addr = !setjmp(pr_addr_jmp);
getnameinfo(sa, salen, address, sizeof address, NULL, 0, getnameinfo_flags | NI_NUMERICHOST);
if (!exiting && !(options & F_NUMERIC))
getnameinfo(sa, salen, name, sizeof name, NULL, 0, getnameinfo_flags);
if (*name)
snprintf(buffer, sizeof buffer, "%s (%s)", name, address);
else
snprintf(buffer, sizeof buffer, "%s", address);
in_pr_addr = 0;
return (buffer);
}
/* Set Type of Service (TOS) and other Quality of Service relating bits */
int parsetos(char *str)
{
const char *cp;
int tos;
char *ep;
/* handle both hex and decimal values */
if (str[0] == '0' && (str[1] == 'x' || str[1] == 'X')) {
cp = str + 2;
tos = (int)strtol(cp, &ep, 16);
} else
tos = (int)strtol(str, &ep, 10);
/* doesn't look like decimal or hex, eh? */
if (*ep != '\0')
error(2, 0, _("bad TOS value: %s"), str);
if (tos > TOS_MAX)
error(2, 0, _("the decimal value of TOS bits must be in range 0-255: %d"), tos);
return (tos);
}
int parseflow(char *str)
{
const char *cp;
unsigned long val;
char *ep;
/* handle both hex and decimal values */
if (str[0] == '0' && (str[1] == 'x' || str[1] == 'X')) {
cp = str + 2;
val = (int)strtoul(cp, &ep, 16);
} else
val = (int)strtoul(str, &ep, 10);
/* doesn't look like decimal or hex, eh? */
if (*ep != '\0')
error(2, 0, _("bad value for flowinfo: %s"), str);
if (val & ~IPV6_FLOWINFO_FLOWLABEL)
error(2, 0, _("flow value is greater than 20 bits: %s"), str);
return (val);
}
void ping4_install_filter(socket_st *sock)
{
static int once;
static struct sock_filter insns[] = {
BPF_STMT(BPF_LDX | BPF_B | BPF_MSH, 0), /* Skip IP header due BSD, see ping6. */
BPF_STMT(BPF_LD | BPF_H | BPF_IND, 4), /* Load icmp echo ident */
BPF_JUMP(BPF_JMP | BPF_JEQ | BPF_K, 0xAAAA, 0, 1), /* Ours? */
BPF_STMT(BPF_RET | BPF_K, ~0U), /* Yes, it passes. */
BPF_STMT(BPF_LD | BPF_B | BPF_IND, 0), /* Load icmp type */
BPF_JUMP(BPF_JMP | BPF_JEQ | BPF_K, ICMP_ECHOREPLY, 1, 0), /* Echo? */
BPF_STMT(BPF_RET | BPF_K, 0xFFFFFFF), /* No. It passes. */
BPF_STMT(BPF_RET | BPF_K, 0) /* Echo with wrong ident. Reject. */
};
static struct sock_fprog filter = {
sizeof insns / sizeof(insns[0]),
insns
};
if (once)
return;
once = 1;
/* Patch bpflet for current identifier. */
insns[2] = (struct sock_filter)BPF_JUMP(BPF_JMP | BPF_JEQ | BPF_K, htons(ident), 0, 1);
if (setsockopt(sock->fd, SOL_SOCKET, SO_ATTACH_FILTER, &filter, sizeof(filter)))
error(0, errno, _("WARNING: failed to install socket filter"));
}