blob: e70bb7e727c2d012679daed2ffea391dd37beed2 [file] [log] [blame]
Erik Andersene49d5ec2000-02-08 19:58:47 +00001/* vi: set sw=4 ts=4: */
Eric Andersen485b9551999-12-07 23:14:59 +00002/*
Eric Andersen485b9551999-12-07 23:14:59 +00003 * Mini ping implementation for busybox
4 *
5 * Copyright (C) 1999 by Randolph Chung <tausq@debian.org>
6 *
Rob Landley42eddba2005-12-15 08:04:17 +00007 * Adapted from the ping in netkit-base 0.10:
Eric Andersen485b9551999-12-07 23:14:59 +00008 * Copyright (c) 1989 The Regents of the University of California.
Denis Vlasenko35d4da02007-01-22 14:04:27 +00009 * All rights reserved.
10 *
11 * This code is derived from software contributed to Berkeley by
12 * Mike Muuss.
Eric Andersen485b9551999-12-07 23:14:59 +000013 *
Denys Vlasenko0ef64bd2010-08-16 20:14:46 +020014 * Licensed under GPLv2 or later, see file LICENSE in this source tree.
Eric Andersen485b9551999-12-07 23:14:59 +000015 */
Denis Vlasenkob9a279b2007-01-24 23:53:22 +000016/* from ping6.c:
17 * Copyright (C) 1999 by Randolph Chung <tausq@debian.org>
18 *
19 * This version of ping is adapted from the ping in netkit-base 0.10,
20 * which is:
21 *
22 * Original copyright notice is retained at the end of this file.
23 *
24 * This version is an adaptation of ping.c from busybox.
25 * The code was modified by Bart Visscher <magick@linux-fan.com>
26 */
Eric Andersen485b9551999-12-07 23:14:59 +000027
Denis Vlasenkob9a279b2007-01-24 23:53:22 +000028#include <net/if.h>
Eric Andersen485b9551999-12-07 23:14:59 +000029#include <netinet/ip_icmp.h>
Denis Vlasenkob6adbf12007-05-26 19:00:18 +000030#include "libbb.h"
Denys Vlasenkoe6a2f4c2016-04-21 16:26:30 +020031#include "common_bufsiz.h"
Denis Vlasenkoe9356022007-01-29 18:03:54 +000032
Denys Vlasenko14bd16a2011-07-08 08:49:40 +020033#ifdef __BIONIC__
34/* should be in netinet/ip_icmp.h */
35# define ICMP_DEST_UNREACH 3 /* Destination Unreachable */
36# define ICMP_SOURCE_QUENCH 4 /* Source Quench */
37# define ICMP_REDIRECT 5 /* Redirect (change route) */
38# define ICMP_ECHO 8 /* Echo Request */
39# define ICMP_TIME_EXCEEDED 11 /* Time Exceeded */
40# define ICMP_PARAMETERPROB 12 /* Parameter Problem */
41# define ICMP_TIMESTAMP 13 /* Timestamp Request */
42# define ICMP_TIMESTAMPREPLY 14 /* Timestamp Reply */
43# define ICMP_INFO_REQUEST 15 /* Information Request */
44# define ICMP_INFO_REPLY 16 /* Information Reply */
45# define ICMP_ADDRESS 17 /* Address Mask Request */
46# define ICMP_ADDRESSREPLY 18 /* Address Mask Reply */
47#endif
48
Joachim Nilsson714e2b72010-11-28 23:01:18 +010049//config:config PING
Denys Vlasenko4eed2c62017-07-18 22:01:24 +020050//config: bool "ping (9.5 kb)"
Joachim Nilsson714e2b72010-11-28 23:01:18 +010051//config: default y
Denys Vlasenkoe3b1a1f2011-02-26 22:24:08 +010052//config: select PLATFORM_LINUX
Joachim Nilsson714e2b72010-11-28 23:01:18 +010053//config: help
Denys Vlasenko72089cf2017-07-21 09:50:55 +020054//config: ping uses the ICMP protocol's mandatory ECHO_REQUEST datagram to
55//config: elicit an ICMP ECHO_RESPONSE from a host or gateway.
Joachim Nilsson714e2b72010-11-28 23:01:18 +010056//config:
57//config:config PING6
Denys Vlasenko4eed2c62017-07-18 22:01:24 +020058//config: bool "ping6 (10 kb)"
Joachim Nilsson714e2b72010-11-28 23:01:18 +010059//config: default y
Denys Vlasenko83423972016-11-23 09:25:57 +010060//config: depends on FEATURE_IPV6
Joachim Nilsson714e2b72010-11-28 23:01:18 +010061//config: help
Denys Vlasenko72089cf2017-07-21 09:50:55 +020062//config: Alias to "ping -6".
Joachim Nilsson714e2b72010-11-28 23:01:18 +010063//config:
64//config:config FEATURE_FANCY_PING
65//config: bool "Enable fancy ping output"
66//config: default y
Denys Vlasenko83423972016-11-23 09:25:57 +010067//config: depends on PING || PING6
Joachim Nilsson714e2b72010-11-28 23:01:18 +010068//config: help
Denys Vlasenkoa680f402017-07-21 11:58:43 +020069//config: With this option off, ping will say "HOST is alive!"
70//config: or terminate with SIGALRM in 5 seconds otherwise.
71//config: No command-line options will be recognized.
Joachim Nilsson714e2b72010-11-28 23:01:18 +010072
Denys Vlasenkob9f2d9f2011-01-18 13:58:01 +010073/* Needs socket(AF_INET, SOCK_RAW, IPPROTO_ICMP), therefore BB_SUID_MAYBE: */
74//applet:IF_PING(APPLET(ping, BB_DIR_BIN, BB_SUID_MAYBE))
75//applet:IF_PING6(APPLET(ping6, BB_DIR_BIN, BB_SUID_MAYBE))
Joachim Nilsson714e2b72010-11-28 23:01:18 +010076
77//kbuild:lib-$(CONFIG_PING) += ping.o
78//kbuild:lib-$(CONFIG_PING6) += ping.o
79
80//usage:#if !ENABLE_FEATURE_FANCY_PING
81//usage:# define ping_trivial_usage
82//usage: "HOST"
83//usage:# define ping_full_usage "\n\n"
84//usage: "Send ICMP ECHO_REQUEST packets to network hosts"
85//usage:# define ping6_trivial_usage
86//usage: "HOST"
87//usage:# define ping6_full_usage "\n\n"
88//usage: "Send ICMP ECHO_REQUEST packets to network hosts"
89//usage:#else
90//usage:# define ping_trivial_usage
91//usage: "[OPTIONS] HOST"
92//usage:# define ping_full_usage "\n\n"
93//usage: "Send ICMP ECHO_REQUEST packets to network hosts\n"
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +010094//usage: IF_PING6(
Joachim Nilsson714e2b72010-11-28 23:01:18 +010095//usage: "\n -4,-6 Force IP or IPv6 name resolution"
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +010096//usage: )
Joachim Nilsson714e2b72010-11-28 23:01:18 +010097//usage: "\n -c CNT Send only CNT pings"
Denys Vlasenkof3d705f2017-01-21 03:46:35 +010098//usage: "\n -s SIZE Send SIZE data bytes in packets (default 56)"
Joachim Nilsson714e2b72010-11-28 23:01:18 +010099//usage: "\n -t TTL Set TTL"
Denys Vlasenkof3d705f2017-01-21 03:46:35 +0100100//usage: "\n -I IFACE/IP Source interface or IP address"
101//usage: "\n -W SEC Seconds to wait for the first response (default 10)"
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100102//usage: "\n (after all -c CNT packets are sent)"
103//usage: "\n -w SEC Seconds until ping exits (default:infinite)"
104//usage: "\n (can exit earlier with -c CNT)"
Florian Fainelli6ff05512014-08-27 16:01:25 +0200105//usage: "\n -q Quiet, only display output at start"
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100106//usage: "\n and when finished"
Florian Fainelli6ff05512014-08-27 16:01:25 +0200107//usage: "\n -p Pattern to use for payload"
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100108//usage:
109//usage:# define ping6_trivial_usage
110//usage: "[OPTIONS] HOST"
111//usage:# define ping6_full_usage "\n\n"
112//usage: "Send ICMP ECHO_REQUEST packets to network hosts\n"
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100113//usage: "\n -c CNT Send only CNT pings"
Denys Vlasenkof3d705f2017-01-21 03:46:35 +0100114//usage: "\n -s SIZE Send SIZE data bytes in packets (default 56)"
115//usage: "\n -I IFACE/IP Source interface or IP address"
Florian Fainelli6ff05512014-08-27 16:01:25 +0200116//usage: "\n -q Quiet, only display output at start"
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100117//usage: "\n and when finished"
Florian Fainelli6ff05512014-08-27 16:01:25 +0200118//usage: "\n -p Pattern to use for payload"
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100119//usage:
120//usage:#endif
121//usage:
122//usage:#define ping_example_usage
123//usage: "$ ping localhost\n"
124//usage: "PING slag (127.0.0.1): 56 data bytes\n"
125//usage: "64 bytes from 127.0.0.1: icmp_seq=0 ttl=255 time=20.1 ms\n"
126//usage: "\n"
127//usage: "--- debian ping statistics ---\n"
128//usage: "1 packets transmitted, 1 packets received, 0% packet loss\n"
129//usage: "round-trip min/avg/max = 20.1/20.1/20.1 ms\n"
130//usage:#define ping6_example_usage
131//usage: "$ ping6 ip6-localhost\n"
132//usage: "PING ip6-localhost (::1): 56 data bytes\n"
133//usage: "64 bytes from ::1: icmp6_seq=0 ttl=64 time=20.1 ms\n"
134//usage: "\n"
135//usage: "--- ip6-localhost ping statistics ---\n"
136//usage: "1 packets transmitted, 1 packets received, 0% packet loss\n"
137//usage: "round-trip min/avg/max = 20.1/20.1/20.1 ms\n"
138
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000139#if ENABLE_PING6
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100140# include <netinet/icmp6.h>
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000141/* I see RENUMBERED constants in bits/in.h - !!?
142 * What a fuck is going on with libc? Is it a glibc joke? */
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100143# ifdef IPV6_2292HOPLIMIT
144# undef IPV6_HOPLIMIT
145# define IPV6_HOPLIMIT IPV6_2292HOPLIMIT
146# endif
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000147#endif
Eric Andersen485b9551999-12-07 23:14:59 +0000148
Rob Landleybc68cd12006-03-10 19:22:06 +0000149enum {
150 DEFDATALEN = 56,
151 MAXIPLEN = 60,
152 MAXICMPLEN = 76,
Rob Landleybc68cd12006-03-10 19:22:06 +0000153 MAX_DUP_CHK = (8 * 128),
154 MAXWAIT = 10,
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000155 PINGINTERVAL = 1, /* 1 second */
Denys Vlasenko59f46672013-06-28 00:30:46 +0200156 pingsock = 0,
Rob Landleybc68cd12006-03-10 19:22:06 +0000157};
Eric Andersen485b9551999-12-07 23:14:59 +0000158
Denys Vlasenko59f46672013-06-28 00:30:46 +0200159static void
160#if ENABLE_PING6
161create_icmp_socket(len_and_sockaddr *lsa)
162#else
163create_icmp_socket(void)
164#define create_icmp_socket(lsa) create_icmp_socket()
165#endif
166{
167 int sock;
168#if ENABLE_PING6
169 if (lsa->u.sa.sa_family == AF_INET6)
170 sock = socket(AF_INET6, SOCK_RAW, IPPROTO_ICMPV6);
171 else
172#endif
173 sock = socket(AF_INET, SOCK_RAW, 1); /* 1 == ICMP */
174 if (sock < 0) {
Denys Vlasenkof0058b12014-01-09 11:53:26 +0100175 if (errno == EPERM)
176 bb_error_msg_and_die(bb_msg_perm_denied_are_you_root);
177 bb_perror_msg_and_die(bb_msg_can_not_create_raw_socket);
Denys Vlasenko59f46672013-06-28 00:30:46 +0200178 }
179
180 xmove_fd(sock, pingsock);
181}
182
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000183#if !ENABLE_FEATURE_FANCY_PING
Denis Vlasenko4a5cf162006-11-20 00:48:22 +0000184
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100185/* Simple version */
Denis Vlasenko4a5cf162006-11-20 00:48:22 +0000186
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100187struct globals {
188 char *hostname;
189 char packet[DEFDATALEN + MAXIPLEN + MAXICMPLEN];
Jonas Danielsson4d5acd22016-06-23 18:26:32 +0200190 uint16_t myid;
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100191} FIX_ALIASING;
Denys Vlasenkoe6a2f4c2016-04-21 16:26:30 +0200192#define G (*(struct globals*)bb_common_bufsiz1)
Denys Vlasenko47cfbf32016-04-21 18:18:48 +0200193#define INIT_G() do { setup_common_bufsiz(); } while (0)
Denis Vlasenkocb6874c2006-09-02 16:13:36 +0000194
Denis Vlasenkoa60f84e2008-07-05 09:18:54 +0000195static void noresp(int ign UNUSED_PARAM)
Eric Andersenb5474c42002-03-20 11:59:28 +0000196{
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100197 printf("No response from %s\n", G.hostname);
Eric Andersen4e486a52003-01-12 06:08:33 +0000198 exit(EXIT_FAILURE);
Eric Andersenb5474c42002-03-20 11:59:28 +0000199}
Eric Andersen19db07b1999-12-11 08:41:28 +0000200
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000201static void ping4(len_and_sockaddr *lsa)
Eric Andersen19db07b1999-12-11 08:41:28 +0000202{
Erik Andersene49d5ec2000-02-08 19:58:47 +0000203 struct icmp *pkt;
Denys Vlasenko59f46672013-06-28 00:30:46 +0200204 int c;
Erik Andersene49d5ec2000-02-08 19:58:47 +0000205
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100206 pkt = (struct icmp *) G.packet;
Denys Vlasenko59f46672013-06-28 00:30:46 +0200207 /*memset(pkt, 0, sizeof(G.packet)); already is */
Erik Andersene49d5ec2000-02-08 19:58:47 +0000208 pkt->icmp_type = ICMP_ECHO;
Jonas Danielsson4d5acd22016-06-23 18:26:32 +0200209 pkt->icmp_id = G.myid;
Baruch Siache8f36332011-09-07 17:52:37 +0200210 pkt->icmp_cksum = inet_cksum((uint16_t *) pkt, sizeof(G.packet));
Erik Andersene49d5ec2000-02-08 19:58:47 +0000211
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100212 xsendto(pingsock, G.packet, DEFDATALEN + ICMP_MINLEN, &lsa->u.sa, lsa->len);
Erik Andersene49d5ec2000-02-08 19:58:47 +0000213
Erik Andersene49d5ec2000-02-08 19:58:47 +0000214 /* listen for replies */
215 while (1) {
Denys Vlasenko59f46672013-06-28 00:30:46 +0200216#if 0
Erik Andersene49d5ec2000-02-08 19:58:47 +0000217 struct sockaddr_in from;
Mike Frysinger03e827a2005-07-26 23:00:59 +0000218 socklen_t fromlen = sizeof(from);
Erik Andersene49d5ec2000-02-08 19:58:47 +0000219
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100220 c = recvfrom(pingsock, G.packet, sizeof(G.packet), 0,
Denis Vlasenko806116b2006-12-31 12:14:16 +0000221 (struct sockaddr *) &from, &fromlen);
Denys Vlasenko59f46672013-06-28 00:30:46 +0200222#else
223 c = recv(pingsock, G.packet, sizeof(G.packet), 0);
224#endif
Denis Vlasenko806116b2006-12-31 12:14:16 +0000225 if (c < 0) {
Denis Vlasenko44c2eb22007-01-08 23:55:33 +0000226 if (errno != EINTR)
227 bb_perror_msg("recvfrom");
Erik Andersene49d5ec2000-02-08 19:58:47 +0000228 continue;
229 }
230 if (c >= 76) { /* ip + icmp */
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100231 struct iphdr *iphdr = (struct iphdr *) G.packet;
Erik Andersene49d5ec2000-02-08 19:58:47 +0000232
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100233 pkt = (struct icmp *) (G.packet + (iphdr->ihl << 2)); /* skip ip hdr */
Jonas Danielsson4d5acd22016-06-23 18:26:32 +0200234 if (pkt->icmp_id != G.myid)
235 continue; /* not our ping */
Erik Andersene49d5ec2000-02-08 19:58:47 +0000236 if (pkt->icmp_type == ICMP_ECHOREPLY)
237 break;
238 }
239 }
Eric Andersen19db07b1999-12-11 08:41:28 +0000240}
241
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000242#if ENABLE_PING6
243static void ping6(len_and_sockaddr *lsa)
244{
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000245 struct icmp6_hdr *pkt;
Denys Vlasenko59f46672013-06-28 00:30:46 +0200246 int c;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000247 int sockopt;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000248
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100249 pkt = (struct icmp6_hdr *) G.packet;
Denys Vlasenko59f46672013-06-28 00:30:46 +0200250 /*memset(pkt, 0, sizeof(G.packet)); already is */
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000251 pkt->icmp6_type = ICMP6_ECHO_REQUEST;
Jonas Danielsson4d5acd22016-06-23 18:26:32 +0200252 pkt->icmp6_id = G.myid;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000253
254 sockopt = offsetof(struct icmp6_hdr, icmp6_cksum);
Denys Vlasenkoc52cbea2015-08-24 19:48:03 +0200255 setsockopt_int(pingsock, SOL_RAW, IPV6_CHECKSUM, sockopt);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000256
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100257 xsendto(pingsock, G.packet, DEFDATALEN + sizeof(struct icmp6_hdr), &lsa->u.sa, lsa->len);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000258
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000259 /* listen for replies */
260 while (1) {
Denys Vlasenko59f46672013-06-28 00:30:46 +0200261#if 0
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000262 struct sockaddr_in6 from;
263 socklen_t fromlen = sizeof(from);
264
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100265 c = recvfrom(pingsock, G.packet, sizeof(G.packet), 0,
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000266 (struct sockaddr *) &from, &fromlen);
Denys Vlasenko59f46672013-06-28 00:30:46 +0200267#else
268 c = recv(pingsock, G.packet, sizeof(G.packet), 0);
269#endif
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000270 if (c < 0) {
271 if (errno != EINTR)
272 bb_perror_msg("recvfrom");
273 continue;
274 }
Denys Vlasenko59f46672013-06-28 00:30:46 +0200275 if (c >= ICMP_MINLEN) { /* icmp6_hdr */
Jonas Danielsson4d5acd22016-06-23 18:26:32 +0200276 if (pkt->icmp6_id != G.myid)
277 continue; /* not our ping */
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000278 if (pkt->icmp6_type == ICMP6_ECHO_REPLY)
279 break;
280 }
281 }
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000282}
283#endif
284
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100285#if !ENABLE_PING6
286# define common_ping_main(af, argv) common_ping_main(argv)
287#endif
288static int common_ping_main(sa_family_t af, char **argv)
Eric Andersen19db07b1999-12-11 08:41:28 +0000289{
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000290 len_and_sockaddr *lsa;
Denis Vlasenko3483e852007-07-02 15:47:52 +0000291
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100292 INIT_G();
293
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100294#if ENABLE_PING6
Denis Vlasenko3483e852007-07-02 15:47:52 +0000295 while ((++argv)[0] && argv[0][0] == '-') {
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000296 if (argv[0][1] == '4') {
297 af = AF_INET;
298 continue;
299 }
300 if (argv[0][1] == '6') {
301 af = AF_INET6;
302 continue;
303 }
Manuel Novoa III cad53642003-03-19 09:13:01 +0000304 bb_show_usage();
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000305 }
306#else
307 argv++;
308#endif
309
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100310 G.hostname = *argv;
311 if (!G.hostname)
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000312 bb_show_usage();
313
314#if ENABLE_PING6
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100315 lsa = xhost_and_af2sockaddr(G.hostname, 0, af);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000316#else
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100317 lsa = xhost_and_af2sockaddr(G.hostname, 0, AF_INET);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000318#endif
319 /* Set timer _after_ DNS resolution */
320 signal(SIGALRM, noresp);
321 alarm(5); /* give the host 5000ms to respond */
322
Denys Vlasenko59f46672013-06-28 00:30:46 +0200323 create_icmp_socket(lsa);
Jonas Danielsson4d5acd22016-06-23 18:26:32 +0200324 G.myid = (uint16_t) getpid();
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000325#if ENABLE_PING6
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000326 if (lsa->u.sa.sa_family == AF_INET6)
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000327 ping6(lsa);
328 else
329#endif
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000330 ping4(lsa);
Denys Vlasenkoa680f402017-07-21 11:58:43 +0200331 if (ENABLE_FEATURE_CLEAN_UP)
332 close(pingsock);
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100333 printf("%s is alive!\n", G.hostname);
Matt Kraai3e856ce2000-12-01 02:55:13 +0000334 return EXIT_SUCCESS;
Eric Andersen19db07b1999-12-11 08:41:28 +0000335}
336
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000337
338#else /* FEATURE_FANCY_PING */
339
Denis Vlasenko4a5cf162006-11-20 00:48:22 +0000340
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100341/* Full(er) version */
Denis Vlasenko4a5cf162006-11-20 00:48:22 +0000342
Denys Vlasenko237bedd2016-07-06 21:58:02 +0200343#define OPT_STRING ("qvc:+s:t:+w:+W:+I:np:4" IF_PING6("6"))
Denis Vlasenko4a5cf162006-11-20 00:48:22 +0000344enum {
345 OPT_QUIET = 1 << 0,
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000346 OPT_VERBOSE = 1 << 1,
347 OPT_c = 1 << 2,
348 OPT_s = 1 << 3,
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100349 OPT_t = 1 << 4,
350 OPT_w = 1 << 5,
351 OPT_W = 1 << 6,
352 OPT_I = 1 << 7,
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100353 /*OPT_n = 1 << 8, - ignored */
Florian Fainelli6ff05512014-08-27 16:01:25 +0200354 OPT_p = 1 << 9,
355 OPT_IPV4 = 1 << 10,
356 OPT_IPV6 = (1 << 11) * ENABLE_PING6,
Denis Vlasenko4a5cf162006-11-20 00:48:22 +0000357};
358
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000359
Denis Vlasenko821cc252007-06-04 10:33:48 +0000360struct globals {
Denis Vlasenko1a7afb42007-10-19 21:39:25 +0000361 int if_index;
Denis Vlasenko59f502b2008-10-27 11:54:45 +0000362 char *str_I;
Denis Vlasenko821cc252007-06-04 10:33:48 +0000363 len_and_sockaddr *source_lsa;
364 unsigned datalen;
Denis Vlasenko59f502b2008-10-27 11:54:45 +0000365 unsigned pingcount; /* must be int-sized */
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100366 unsigned opt_ttl;
Denis Vlasenko59f502b2008-10-27 11:54:45 +0000367 unsigned long ntransmitted, nreceived, nrepeats;
Denis Vlasenko821cc252007-06-04 10:33:48 +0000368 uint16_t myid;
Florian Fainelli6ff05512014-08-27 16:01:25 +0200369 uint8_t pattern;
Denis Vlasenko76791452007-06-18 08:55:57 +0000370 unsigned tmin, tmax; /* in us */
371 unsigned long long tsum; /* in us, sum of all times */
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000372 unsigned deadline;
373 unsigned timeout;
374 unsigned total_secs;
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100375 unsigned sizeof_rcv_packet;
376 char *rcv_packet; /* [datalen + MAXIPLEN + MAXICMPLEN] */
377 void *snd_packet; /* [datalen + ipv4/ipv6_const] */
Denis Vlasenko821cc252007-06-04 10:33:48 +0000378 const char *hostname;
379 const char *dotted;
380 union {
381 struct sockaddr sa;
382 struct sockaddr_in sin;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000383#if ENABLE_PING6
Denis Vlasenko821cc252007-06-04 10:33:48 +0000384 struct sockaddr_in6 sin6;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000385#endif
Denis Vlasenko821cc252007-06-04 10:33:48 +0000386 } pingaddr;
Denys Vlasenko26a7e2e2013-06-28 01:33:47 +0200387 unsigned char rcvd_tbl[MAX_DUP_CHK / 8];
Denys Vlasenko98a4c7c2010-02-04 15:00:15 +0100388} FIX_ALIASING;
Denys Vlasenkoe6a2f4c2016-04-21 16:26:30 +0200389#define G (*(struct globals*)bb_common_bufsiz1)
Denis Vlasenko821cc252007-06-04 10:33:48 +0000390#define if_index (G.if_index )
Denis Vlasenko1a7afb42007-10-19 21:39:25 +0000391#define source_lsa (G.source_lsa )
Denis Vlasenko59f502b2008-10-27 11:54:45 +0000392#define str_I (G.str_I )
Denis Vlasenko1a7afb42007-10-19 21:39:25 +0000393#define datalen (G.datalen )
Denis Vlasenko821cc252007-06-04 10:33:48 +0000394#define pingcount (G.pingcount )
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100395#define opt_ttl (G.opt_ttl )
Denis Vlasenko821cc252007-06-04 10:33:48 +0000396#define myid (G.myid )
397#define tmin (G.tmin )
398#define tmax (G.tmax )
399#define tsum (G.tsum )
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000400#define deadline (G.deadline )
401#define timeout (G.timeout )
402#define total_secs (G.total_secs )
Denis Vlasenko821cc252007-06-04 10:33:48 +0000403#define hostname (G.hostname )
404#define dotted (G.dotted )
405#define pingaddr (G.pingaddr )
406#define rcvd_tbl (G.rcvd_tbl )
Denis Vlasenko821cc252007-06-04 10:33:48 +0000407#define INIT_G() do { \
Denys Vlasenko47cfbf32016-04-21 18:18:48 +0200408 setup_common_bufsiz(); \
Denys Vlasenkoab3964d2015-10-13 14:50:20 +0200409 BUILD_BUG_ON(sizeof(G) > COMMON_BUFSIZE); \
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000410 datalen = DEFDATALEN; \
411 timeout = MAXWAIT; \
Denis Vlasenko821cc252007-06-04 10:33:48 +0000412 tmin = UINT_MAX; \
413} while (0)
Eric Andersen19db07b1999-12-11 08:41:28 +0000414
Eric Andersen19db07b1999-12-11 08:41:28 +0000415
Denys Vlasenko26a7e2e2013-06-28 01:33:47 +0200416#define BYTE(bit) rcvd_tbl[(bit)>>3]
417#define MASK(bit) (1 << ((bit) & 7))
418#define SET(bit) (BYTE(bit) |= MASK(bit))
419#define CLR(bit) (BYTE(bit) &= (~MASK(bit)))
420#define TST(bit) (BYTE(bit) & MASK(bit))
Eric Andersen19db07b1999-12-11 08:41:28 +0000421
Denis Vlasenkoa60f84e2008-07-05 09:18:54 +0000422static void print_stats_and_exit(int junk) NORETURN;
423static void print_stats_and_exit(int junk UNUSED_PARAM)
Erik Andersene49d5ec2000-02-08 19:58:47 +0000424{
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100425 unsigned long ul;
426 unsigned long nrecv;
427
Erik Andersene49d5ec2000-02-08 19:58:47 +0000428 signal(SIGINT, SIG_IGN);
429
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100430 nrecv = G.nreceived;
431 printf("\n--- %s ping statistics ---\n"
432 "%lu packets transmitted, "
433 "%lu packets received, ",
434 hostname, G.ntransmitted, nrecv
435 );
436 if (G.nrepeats)
437 printf("%lu duplicates, ", G.nrepeats);
438 ul = G.ntransmitted;
439 if (ul != 0)
440 ul = (ul - nrecv) * 100 / ul;
441 printf("%lu%% packet loss\n", ul);
Denis Vlasenko76791452007-06-18 08:55:57 +0000442 if (tmin != UINT_MAX) {
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100443 unsigned tavg = tsum / (nrecv + G.nrepeats);
Denis Vlasenko76791452007-06-18 08:55:57 +0000444 printf("round-trip min/avg/max = %u.%03u/%u.%03u/%u.%03u ms\n",
445 tmin / 1000, tmin % 1000,
446 tavg / 1000, tavg % 1000,
447 tmax / 1000, tmax % 1000);
448 }
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000449 /* if condition is true, exit with 1 -- 'failure' */
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100450 exit(nrecv == 0 || (deadline && nrecv < pingcount));
Eric Andersen485b9551999-12-07 23:14:59 +0000451}
452
Denys Vlasenko281e7b82011-02-06 17:51:45 +0100453static void sendping_tail(void (*sp)(int), int size_pkt)
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000454{
Denis Vlasenkoc8e99932007-02-09 18:14:42 +0000455 int sz;
456
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100457 CLR((uint16_t)G.ntransmitted % MAX_DUP_CHK);
458 G.ntransmitted++;
Denis Vlasenkoc8e99932007-02-09 18:14:42 +0000459
Denys Vlasenko281e7b82011-02-06 17:51:45 +0100460 size_pkt += datalen;
461
Denis Vlasenkoc8e99932007-02-09 18:14:42 +0000462 /* sizeof(pingaddr) can be larger than real sa size, but I think
463 * it doesn't matter */
Denys Vlasenko281e7b82011-02-06 17:51:45 +0100464 sz = xsendto(pingsock, G.snd_packet, size_pkt, &pingaddr.sa, sizeof(pingaddr));
Denis Vlasenkoc8e99932007-02-09 18:14:42 +0000465 if (sz != size_pkt)
Bernhard Reutner-Fischerb2908892007-04-12 11:34:39 +0000466 bb_error_msg_and_die(bb_msg_write_error);
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000467
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100468 if (pingcount == 0 || deadline || G.ntransmitted < pingcount) {
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000469 /* Didn't send all pings yet - schedule next in 1s */
470 signal(SIGALRM, sp);
471 if (deadline) {
472 total_secs += PINGINTERVAL;
473 if (total_secs >= deadline)
474 signal(SIGALRM, print_stats_and_exit);
475 }
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000476 alarm(PINGINTERVAL);
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000477 } else { /* -c NN, and all NN are sent (and no deadline) */
478 /* Wait for the last ping to come back.
479 * -W timeout: wait for a response in seconds.
Denys Vlasenko10ad6222017-04-17 16:13:32 +0200480 * Affects only timeout in absence of any responses,
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000481 * otherwise ping waits for two RTTs. */
482 unsigned expire = timeout;
483
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100484 if (G.nreceived) {
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000485 /* approx. 2*tmax, in seconds (2 RTT) */
486 expire = tmax / (512*1024);
487 if (expire == 0)
488 expire = 1;
489 }
490 signal(SIGALRM, print_stats_and_exit);
491 alarm(expire);
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000492 }
493}
494
Denis Vlasenkoa60f84e2008-07-05 09:18:54 +0000495static void sendping4(int junk UNUSED_PARAM)
Eric Andersen485b9551999-12-07 23:14:59 +0000496{
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100497 struct icmp *pkt = G.snd_packet;
Eric Andersen485b9551999-12-07 23:14:59 +0000498
Florian Fainelli6ff05512014-08-27 16:01:25 +0200499 memset(pkt, G.pattern, datalen + ICMP_MINLEN + 4);
Erik Andersene49d5ec2000-02-08 19:58:47 +0000500 pkt->icmp_type = ICMP_ECHO;
Denis Vlasenkob34266b2008-04-29 12:31:53 +0000501 /*pkt->icmp_code = 0;*/
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100502 pkt->icmp_cksum = 0; /* cksum is calculated with this field set to 0 */
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100503 pkt->icmp_seq = htons(G.ntransmitted); /* don't ++ here, it can be a macro */
Erik Andersene49d5ec2000-02-08 19:58:47 +0000504 pkt->icmp_id = myid;
Denis Vlasenko7b72fc12007-06-16 13:37:59 +0000505
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100506 /* If datalen < 4, we store timestamp _past_ the packet,
507 * but it's ok - we allocated 4 extra bytes in xzalloc() just in case.
508 */
Denis Vlasenko76791452007-06-18 08:55:57 +0000509 /*if (datalen >= 4)*/
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100510 /* No hton: we'll read it back on the same machine */
Denis Vlasenko76791452007-06-18 08:55:57 +0000511 *(uint32_t*)&pkt->icmp_dun = monotonic_us();
Denis Vlasenko7b72fc12007-06-16 13:37:59 +0000512
Baruch Siache8f36332011-09-07 17:52:37 +0200513 pkt->icmp_cksum = inet_cksum((uint16_t *) pkt, datalen + ICMP_MINLEN);
Eric Andersen485b9551999-12-07 23:14:59 +0000514
Denys Vlasenko281e7b82011-02-06 17:51:45 +0100515 sendping_tail(sendping4, ICMP_MINLEN);
Eric Andersen485b9551999-12-07 23:14:59 +0000516}
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000517#if ENABLE_PING6
Denis Vlasenkoa60f84e2008-07-05 09:18:54 +0000518static void sendping6(int junk UNUSED_PARAM)
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000519{
Denys Vlasenko1bb52a92011-02-05 03:58:43 +0100520 struct icmp6_hdr *pkt = G.snd_packet;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000521
Florian Fainelli6ff05512014-08-27 16:01:25 +0200522 memset(pkt, G.pattern, datalen + sizeof(struct icmp6_hdr) + 4);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000523 pkt->icmp6_type = ICMP6_ECHO_REQUEST;
Denis Vlasenkob34266b2008-04-29 12:31:53 +0000524 /*pkt->icmp6_code = 0;*/
525 /*pkt->icmp6_cksum = 0;*/
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100526 pkt->icmp6_seq = htons(G.ntransmitted); /* don't ++ here, it can be a macro */
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000527 pkt->icmp6_id = myid;
Denis Vlasenko7b72fc12007-06-16 13:37:59 +0000528
Denis Vlasenko76791452007-06-18 08:55:57 +0000529 /*if (datalen >= 4)*/
Denys Vlasenko5117eff2013-10-16 14:21:20 +0200530 *(bb__aliased_uint32_t*)(&pkt->icmp6_data8[4]) = monotonic_us();
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000531
Baruch Siache8f36332011-09-07 17:52:37 +0200532 //TODO? pkt->icmp_cksum = inet_cksum(...);
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100533
Denys Vlasenko281e7b82011-02-06 17:51:45 +0100534 sendping_tail(sendping6, sizeof(struct icmp6_hdr));
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000535}
536#endif
Erik Andersene49d5ec2000-02-08 19:58:47 +0000537
Denis Vlasenko89ef65f2007-01-29 23:43:18 +0000538static const char *icmp_type_name(int id)
Erik Andersen227a59b2000-04-25 23:24:55 +0000539{
540 switch (id) {
Denis Vlasenko35d4da02007-01-22 14:04:27 +0000541 case ICMP_ECHOREPLY: return "Echo Reply";
542 case ICMP_DEST_UNREACH: return "Destination Unreachable";
543 case ICMP_SOURCE_QUENCH: return "Source Quench";
544 case ICMP_REDIRECT: return "Redirect (change route)";
545 case ICMP_ECHO: return "Echo Request";
546 case ICMP_TIME_EXCEEDED: return "Time Exceeded";
547 case ICMP_PARAMETERPROB: return "Parameter Problem";
548 case ICMP_TIMESTAMP: return "Timestamp Request";
549 case ICMP_TIMESTAMPREPLY: return "Timestamp Reply";
550 case ICMP_INFO_REQUEST: return "Information Request";
551 case ICMP_INFO_REPLY: return "Information Reply";
552 case ICMP_ADDRESS: return "Address Mask Request";
553 case ICMP_ADDRESSREPLY: return "Address Mask Reply";
554 default: return "unknown ICMP type";
Erik Andersen227a59b2000-04-25 23:24:55 +0000555 }
556}
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000557#if ENABLE_PING6
558/* RFC3542 changed some definitions from RFC2292 for no good reason, whee!
559 * the newer 3542 uses a MLD_ prefix where as 2292 uses ICMP6_ prefix */
560#ifndef MLD_LISTENER_QUERY
561# define MLD_LISTENER_QUERY ICMP6_MEMBERSHIP_QUERY
562#endif
563#ifndef MLD_LISTENER_REPORT
564# define MLD_LISTENER_REPORT ICMP6_MEMBERSHIP_REPORT
565#endif
566#ifndef MLD_LISTENER_REDUCTION
567# define MLD_LISTENER_REDUCTION ICMP6_MEMBERSHIP_REDUCTION
568#endif
Denis Vlasenko89ef65f2007-01-29 23:43:18 +0000569static const char *icmp6_type_name(int id)
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000570{
571 switch (id) {
572 case ICMP6_DST_UNREACH: return "Destination Unreachable";
573 case ICMP6_PACKET_TOO_BIG: return "Packet too big";
574 case ICMP6_TIME_EXCEEDED: return "Time Exceeded";
575 case ICMP6_PARAM_PROB: return "Parameter Problem";
576 case ICMP6_ECHO_REPLY: return "Echo Reply";
577 case ICMP6_ECHO_REQUEST: return "Echo Request";
578 case MLD_LISTENER_QUERY: return "Listener Query";
579 case MLD_LISTENER_REPORT: return "Listener Report";
580 case MLD_LISTENER_REDUCTION: return "Listener Reduction";
581 default: return "unknown ICMP type";
582 }
583}
584#endif
Erik Andersen227a59b2000-04-25 23:24:55 +0000585
Denis Vlasenko76791452007-06-18 08:55:57 +0000586static void unpack_tail(int sz, uint32_t *tp,
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000587 const char *from_str,
588 uint16_t recv_seq, int ttl)
589{
Denys Vlasenko26a7e2e2013-06-28 01:33:47 +0200590 unsigned char *b, m;
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000591 const char *dupmsg = " (DUP!)";
592 unsigned triptime = triptime; /* for gcc */
593
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000594 if (tp) {
Denis Vlasenko76791452007-06-18 08:55:57 +0000595 /* (int32_t) cast is for hypothetical 64-bit unsigned */
596 /* (doesn't hurt 32-bit real-world anyway) */
597 triptime = (int32_t) ((uint32_t)monotonic_us() - *tp);
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000598 tsum += triptime;
599 if (triptime < tmin)
600 tmin = triptime;
601 if (triptime > tmax)
602 tmax = triptime;
603 }
604
Denys Vlasenko26a7e2e2013-06-28 01:33:47 +0200605 b = &BYTE(recv_seq % MAX_DUP_CHK);
606 m = MASK(recv_seq % MAX_DUP_CHK);
607 /*if TST(recv_seq % MAX_DUP_CHK):*/
608 if (*b & m) {
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100609 ++G.nrepeats;
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000610 } else {
Denys Vlasenko26a7e2e2013-06-28 01:33:47 +0200611 /*SET(recv_seq % MAX_DUP_CHK):*/
612 *b |= m;
613 ++G.nreceived;
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000614 dupmsg += 7;
615 }
616
617 if (option_mask32 & OPT_QUIET)
618 return;
619
620 printf("%d bytes from %s: seq=%u ttl=%d", sz,
621 from_str, recv_seq, ttl);
622 if (tp)
Denis Vlasenko76791452007-06-18 08:55:57 +0000623 printf(" time=%u.%03u ms", triptime / 1000, triptime % 1000);
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000624 puts(dupmsg);
Denys Vlasenko8131eea2009-11-02 14:19:51 +0100625 fflush_all();
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000626}
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000627static void unpack4(char *buf, int sz, struct sockaddr_in *from)
Eric Andersen485b9551999-12-07 23:14:59 +0000628{
Erik Andersene49d5ec2000-02-08 19:58:47 +0000629 struct icmp *icmppkt;
630 struct iphdr *iphdr;
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000631 int hlen;
Eric Andersen485b9551999-12-07 23:14:59 +0000632
Erik Andersene49d5ec2000-02-08 19:58:47 +0000633 /* discard if too short */
Pavel Roskin0024abc2000-06-07 20:38:15 +0000634 if (sz < (datalen + ICMP_MINLEN))
Erik Andersene49d5ec2000-02-08 19:58:47 +0000635 return;
Eric Andersen485b9551999-12-07 23:14:59 +0000636
Denis Vlasenko2cbe6e62006-09-02 16:17:30 +0000637 /* check IP header */
638 iphdr = (struct iphdr *) buf;
639 hlen = iphdr->ihl << 2;
Erik Andersene49d5ec2000-02-08 19:58:47 +0000640 sz -= hlen;
641 icmppkt = (struct icmp *) (buf + hlen);
Erik Andersen227a59b2000-04-25 23:24:55 +0000642 if (icmppkt->icmp_id != myid)
Denis Vlasenkocb6874c2006-09-02 16:13:36 +0000643 return; /* not our ping */
Erik Andersen227a59b2000-04-25 23:24:55 +0000644
Erik Andersene49d5ec2000-02-08 19:58:47 +0000645 if (icmppkt->icmp_type == ICMP_ECHOREPLY) {
Denis Vlasenko35d4da02007-01-22 14:04:27 +0000646 uint16_t recv_seq = ntohs(icmppkt->icmp_seq);
Denis Vlasenko76791452007-06-18 08:55:57 +0000647 uint32_t *tp = NULL;
Erik Andersene49d5ec2000-02-08 19:58:47 +0000648
Denis Vlasenko76791452007-06-18 08:55:57 +0000649 if (sz >= ICMP_MINLEN + sizeof(uint32_t))
650 tp = (uint32_t *) icmppkt->icmp_data;
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000651 unpack_tail(sz, tp,
652 inet_ntoa(*(struct in_addr *) &from->sin_addr.s_addr),
653 recv_seq, iphdr->ttl);
654 } else if (icmppkt->icmp_type != ICMP_ECHO) {
655 bb_error_msg("warning: got ICMP %d (%s)",
656 icmppkt->icmp_type,
657 icmp_type_name(icmppkt->icmp_type));
Denis Vlasenko35d4da02007-01-22 14:04:27 +0000658 }
Eric Andersen485b9551999-12-07 23:14:59 +0000659}
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000660#if ENABLE_PING6
Denys Vlasenko5126cf92011-09-11 20:27:28 +0200661static void unpack6(char *packet, int sz, struct sockaddr_in6 *from, int hoplimit)
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000662{
663 struct icmp6_hdr *icmppkt;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000664 char buf[INET6_ADDRSTRLEN];
Eric Andersen485b9551999-12-07 23:14:59 +0000665
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000666 /* discard if too short */
667 if (sz < (datalen + sizeof(struct icmp6_hdr)))
668 return;
669
670 icmppkt = (struct icmp6_hdr *) packet;
671 if (icmppkt->icmp6_id != myid)
672 return; /* not our ping */
673
674 if (icmppkt->icmp6_type == ICMP6_ECHO_REPLY) {
675 uint16_t recv_seq = ntohs(icmppkt->icmp6_seq);
Denis Vlasenko76791452007-06-18 08:55:57 +0000676 uint32_t *tp = NULL;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000677
Denis Vlasenko76791452007-06-18 08:55:57 +0000678 if (sz >= sizeof(struct icmp6_hdr) + sizeof(uint32_t))
679 tp = (uint32_t *) &icmppkt->icmp6_data8[4];
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000680 unpack_tail(sz, tp,
Denys Vlasenko5126cf92011-09-11 20:27:28 +0200681 inet_ntop(AF_INET6, &from->sin6_addr,
Denis Vlasenko19c238b2007-03-03 00:36:35 +0000682 buf, sizeof(buf)),
683 recv_seq, hoplimit);
684 } else if (icmppkt->icmp6_type != ICMP6_ECHO_REQUEST) {
685 bb_error_msg("warning: got ICMP %d (%s)",
686 icmppkt->icmp6_type,
687 icmp6_type_name(icmppkt->icmp6_type));
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000688 }
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000689}
690#endif
691
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000692static void ping4(len_and_sockaddr *lsa)
Eric Andersen485b9551999-12-07 23:14:59 +0000693{
Erik Andersene49d5ec2000-02-08 19:58:47 +0000694 int sockopt;
695
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000696 pingaddr.sin = lsa->u.sin;
Denis Vlasenko5ad10482007-06-19 22:54:21 +0000697 if (source_lsa) {
698 if (setsockopt(pingsock, IPPROTO_IP, IP_MULTICAST_IF,
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000699 &source_lsa->u.sa, source_lsa->len))
Denis Vlasenko5ad10482007-06-19 22:54:21 +0000700 bb_error_msg_and_die("can't set multicast source interface");
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000701 xbind(pingsock, &source_lsa->u.sa, source_lsa->len);
Denis Vlasenko5ad10482007-06-19 22:54:21 +0000702 }
Denis Vlasenko2cbe6e62006-09-02 16:17:30 +0000703
Erik Andersene49d5ec2000-02-08 19:58:47 +0000704 /* enable broadcast pings */
Denis Vlasenko48237b02006-11-22 23:22:06 +0000705 setsockopt_broadcast(pingsock);
Erik Andersene49d5ec2000-02-08 19:58:47 +0000706
Denis Vlasenko57707152008-08-24 00:02:18 +0000707 /* set recv buf (needed if we can get lots of responses: flood ping,
708 * broadcast ping etc) */
709 sockopt = (datalen * 2) + 7 * 1024; /* giving it a bit of extra room */
Denys Vlasenkoc52cbea2015-08-24 19:48:03 +0200710 setsockopt_SOL_SOCKET_int(pingsock, SO_RCVBUF, sockopt);
Erik Andersene49d5ec2000-02-08 19:58:47 +0000711
Denys Vlasenko3c8799b2010-11-29 12:07:12 +0100712 if (opt_ttl != 0) {
Denys Vlasenkoc52cbea2015-08-24 19:48:03 +0200713 setsockopt_int(pingsock, IPPROTO_IP, IP_TTL, opt_ttl);
Denys Vlasenko10ad6222017-04-17 16:13:32 +0200714 /* above doesn't affect packets sent to bcast IP, so... */
Denys Vlasenkoc52cbea2015-08-24 19:48:03 +0200715 setsockopt_int(pingsock, IPPROTO_IP, IP_MULTICAST_TTL, opt_ttl);
Denys Vlasenko3c8799b2010-11-29 12:07:12 +0100716 }
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100717
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000718 signal(SIGINT, print_stats_and_exit);
Erik Andersene49d5ec2000-02-08 19:58:47 +0000719
720 /* start the ping's going ... */
Denis Vlasenkoe9356022007-01-29 18:03:54 +0000721 sendping4(0);
Erik Andersene49d5ec2000-02-08 19:58:47 +0000722
723 /* listen for replies */
724 while (1) {
725 struct sockaddr_in from;
Erik Andersen1d1d9502000-04-21 01:26:49 +0000726 socklen_t fromlen = (socklen_t) sizeof(from);
Erik Andersene49d5ec2000-02-08 19:58:47 +0000727 int c;
728
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100729 c = recvfrom(pingsock, G.rcv_packet, G.sizeof_rcv_packet, 0,
Denis Vlasenko44c2eb22007-01-08 23:55:33 +0000730 (struct sockaddr *) &from, &fromlen);
731 if (c < 0) {
732 if (errno != EINTR)
733 bb_perror_msg("recvfrom");
Erik Andersene49d5ec2000-02-08 19:58:47 +0000734 continue;
735 }
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100736 unpack4(G.rcv_packet, c, &from);
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100737 if (pingcount && G.nreceived >= pingcount)
Erik Andersene49d5ec2000-02-08 19:58:47 +0000738 break;
739 }
Eric Andersen485b9551999-12-07 23:14:59 +0000740}
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000741#if ENABLE_PING6
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000742static void ping6(len_and_sockaddr *lsa)
743{
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000744 int sockopt;
745 struct msghdr msg;
746 struct sockaddr_in6 from;
747 struct iovec iov;
748 char control_buf[CMSG_SPACE(36)];
749
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000750 pingaddr.sin6 = lsa->u.sin6;
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000751 if (source_lsa)
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000752 xbind(pingsock, &source_lsa->u.sa, source_lsa->len);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000753
754#ifdef ICMP6_FILTER
755 {
756 struct icmp6_filter filt;
757 if (!(option_mask32 & OPT_VERBOSE)) {
758 ICMP6_FILTER_SETBLOCKALL(&filt);
759 ICMP6_FILTER_SETPASS(ICMP6_ECHO_REPLY, &filt);
760 } else {
761 ICMP6_FILTER_SETPASSALL(&filt);
762 }
763 if (setsockopt(pingsock, IPPROTO_ICMPV6, ICMP6_FILTER, &filt,
Denys Vlasenko69675782013-01-14 01:34:48 +0100764 sizeof(filt)) < 0)
Denys Vlasenko2db782b2015-08-24 19:08:14 +0200765 bb_error_msg_and_die("setsockopt(%s)", "ICMP6_FILTER");
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000766 }
767#endif /*ICMP6_FILTER*/
768
769 /* enable broadcast pings */
770 setsockopt_broadcast(pingsock);
771
Denis Vlasenko57707152008-08-24 00:02:18 +0000772 /* set recv buf (needed if we can get lots of responses: flood ping,
773 * broadcast ping etc) */
774 sockopt = (datalen * 2) + 7 * 1024; /* giving it a bit of extra room */
Denys Vlasenkoc52cbea2015-08-24 19:48:03 +0200775 setsockopt_SOL_SOCKET_int(pingsock, SO_RCVBUF, sockopt);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000776
777 sockopt = offsetof(struct icmp6_hdr, icmp6_cksum);
Denys Vlasenkoab3964d2015-10-13 14:50:20 +0200778 BUILD_BUG_ON(offsetof(struct icmp6_hdr, icmp6_cksum) != 2);
Denys Vlasenkoc52cbea2015-08-24 19:48:03 +0200779 setsockopt_int(pingsock, SOL_RAW, IPV6_CHECKSUM, sockopt);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000780
781 /* request ttl info to be returned in ancillary data */
Denys Vlasenkoc52cbea2015-08-24 19:48:03 +0200782 setsockopt_1(pingsock, SOL_IPV6, IPV6_HOPLIMIT);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000783
784 if (if_index)
Denis Vlasenkoaeb4bdd2007-01-25 00:00:02 +0000785 pingaddr.sin6.sin6_scope_id = if_index;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000786
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000787 signal(SIGINT, print_stats_and_exit);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000788
789 /* start the ping's going ... */
790 sendping6(0);
791
792 /* listen for replies */
793 msg.msg_name = &from;
794 msg.msg_namelen = sizeof(from);
795 msg.msg_iov = &iov;
796 msg.msg_iovlen = 1;
797 msg.msg_control = control_buf;
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100798 iov.iov_base = G.rcv_packet;
799 iov.iov_len = G.sizeof_rcv_packet;
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000800 while (1) {
801 int c;
802 struct cmsghdr *mp;
803 int hoplimit = -1;
804 msg.msg_controllen = sizeof(control_buf);
805
806 c = recvmsg(pingsock, &msg, 0);
807 if (c < 0) {
808 if (errno != EINTR)
809 bb_perror_msg("recvfrom");
810 continue;
811 }
812 for (mp = CMSG_FIRSTHDR(&msg); mp; mp = CMSG_NXTHDR(&msg, mp)) {
813 if (mp->cmsg_level == SOL_IPV6
814 && mp->cmsg_type == IPV6_HOPLIMIT
815 /* don't check len - we trust the kernel: */
816 /* && mp->cmsg_len >= CMSG_LEN(sizeof(int)) */
817 ) {
Denys Vlasenko57be1ee2009-11-26 15:26:31 +0100818 /*hoplimit = *(int*)CMSG_DATA(mp); - unaligned access */
819 move_from_unaligned_int(hoplimit, CMSG_DATA(mp));
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000820 }
821 }
Denys Vlasenko5126cf92011-09-11 20:27:28 +0200822 unpack6(G.rcv_packet, c, &from, hoplimit);
Denys Vlasenkoaf4a07a2013-03-15 00:11:35 +0100823 if (pingcount && G.nreceived >= pingcount)
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000824 break;
825 }
826}
827#endif
Eric Andersen485b9551999-12-07 23:14:59 +0000828
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000829static void ping(len_and_sockaddr *lsa)
Denis Vlasenko2cbe6e62006-09-02 16:17:30 +0000830{
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000831 printf("PING %s (%s)", hostname, dotted);
832 if (source_lsa) {
833 printf(" from %s",
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000834 xmalloc_sockaddr2dotted_noport(&source_lsa->u.sa));
Denis Vlasenko2cbe6e62006-09-02 16:17:30 +0000835 }
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000836 printf(": %d data bytes\n", datalen);
837
Denys Vlasenko59f46672013-06-28 00:30:46 +0200838 create_icmp_socket(lsa);
839 /* untested whether "-I addr" really works for IPv6: */
840 if (str_I)
841 setsockopt_bindtodevice(pingsock, str_I);
842
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100843 G.sizeof_rcv_packet = datalen + MAXIPLEN + MAXICMPLEN;
844 G.rcv_packet = xzalloc(G.sizeof_rcv_packet);
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000845#if ENABLE_PING6
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100846 if (lsa->u.sa.sa_family == AF_INET6) {
847 /* +4 reserves a place for timestamp, which may end up sitting
848 * _after_ packet. Saves one if() - see sendping4/6() */
849 G.snd_packet = xzalloc(datalen + sizeof(struct icmp6_hdr) + 4);
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000850 ping6(lsa);
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100851 } else
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000852#endif
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100853 {
854 G.snd_packet = xzalloc(datalen + ICMP_MINLEN + 4);
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000855 ping4(lsa);
Denys Vlasenko9341fd22010-03-03 01:10:29 +0100856 }
Denis Vlasenko2cbe6e62006-09-02 16:17:30 +0000857}
858
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100859static int common_ping_main(int opt, char **argv)
Eric Andersen485b9551999-12-07 23:14:59 +0000860{
Denis Vlasenkoaeb4bdd2007-01-25 00:00:02 +0000861 len_and_sockaddr *lsa;
Florian Fainelli6ff05512014-08-27 16:01:25 +0200862 char *str_s, *str_p;
Eric Andersen485b9551999-12-07 23:14:59 +0000863
Denis Vlasenko821cc252007-06-04 10:33:48 +0000864 INIT_G();
865
Joachim Nilsson714e2b72010-11-28 23:01:18 +0100866 /* exactly one argument needed; -v and -q don't mix; -c NUM, -t NUM, -w NUM, -W NUM */
Denys Vlasenko237bedd2016-07-06 21:58:02 +0200867 opt_complementary = "=1:q--v:v--q";
Florian Fainelli6ff05512014-08-27 16:01:25 +0200868 opt |= getopt32(argv, OPT_STRING, &pingcount, &str_s, &opt_ttl, &deadline, &timeout, &str_I, &str_p);
Denis Vlasenko59f502b2008-10-27 11:54:45 +0000869 if (opt & OPT_s)
870 datalen = xatou16(str_s); // -s
871 if (opt & OPT_I) { // -I
872 if_index = if_nametoindex(str_I);
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000873 if (!if_index) {
874 /* TODO: I'm not sure it takes IPv6 unless in [XX:XX..] format */
Denis Vlasenko59f502b2008-10-27 11:54:45 +0000875 source_lsa = xdotted2sockaddr(str_I, 0);
876 str_I = NULL; /* don't try to bind to device later */
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000877 }
Erik Andersene49d5ec2000-02-08 19:58:47 +0000878 }
Florian Fainelli6ff05512014-08-27 16:01:25 +0200879 if (opt & OPT_p)
880 G.pattern = xstrtou_range(str_p, 16, 0, 255);
881
Denis Vlasenko1c9ad622007-05-27 00:53:41 +0000882 myid = (uint16_t) getpid();
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000883 hostname = argv[optind];
884#if ENABLE_PING6
Denis Vlasenko59f502b2008-10-27 11:54:45 +0000885 {
886 sa_family_t af = AF_UNSPEC;
887 if (opt & OPT_IPV4)
888 af = AF_INET;
889 if (opt & OPT_IPV6)
890 af = AF_INET6;
891 lsa = xhost_and_af2sockaddr(hostname, 0, af);
892 }
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000893#else
Denis Vlasenko42823d52007-02-04 02:39:08 +0000894 lsa = xhost_and_af2sockaddr(hostname, 0, AF_INET);
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000895#endif
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000896
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000897 if (source_lsa && source_lsa->u.sa.sa_family != lsa->u.sa.sa_family)
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000898 /* leaking it here... */
899 source_lsa = NULL;
900
Bernhard Reutner-Fischer8c69afd2008-01-29 10:33:34 +0000901 dotted = xmalloc_sockaddr2dotted_noport(&lsa->u.sa);
Denis Vlasenko9ca26d32007-02-09 17:32:16 +0000902 ping(lsa);
Bernhard Reutner-Fischer636a1f82008-05-19 09:29:47 +0000903 print_stats_and_exit(EXIT_SUCCESS);
Denis Vlasenko90c31b32008-04-07 00:46:29 +0000904 /*return EXIT_SUCCESS;*/
Eric Andersen485b9551999-12-07 23:14:59 +0000905}
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000906#endif /* FEATURE_FANCY_PING */
907
908
Denys Vlasenko83423972016-11-23 09:25:57 +0100909#if ENABLE_PING
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100910int ping_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
911int ping_main(int argc UNUSED_PARAM, char **argv)
912{
Denys Vlasenko83423972016-11-23 09:25:57 +0100913# if !ENABLE_FEATURE_FANCY_PING
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100914 return common_ping_main(AF_UNSPEC, argv);
Denys Vlasenko83423972016-11-23 09:25:57 +0100915# else
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100916 return common_ping_main(0, argv);
Denys Vlasenko83423972016-11-23 09:25:57 +0100917# endif
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100918}
Denys Vlasenko83423972016-11-23 09:25:57 +0100919#endif
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100920
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000921#if ENABLE_PING6
Denis Vlasenko9b49a5e2007-10-11 10:05:36 +0000922int ping6_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
Denis Vlasenko59f502b2008-10-27 11:54:45 +0000923int ping6_main(int argc UNUSED_PARAM, char **argv)
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000924{
Denys Vlasenkoad7d94b2009-11-20 18:12:12 +0100925# if !ENABLE_FEATURE_FANCY_PING
926 return common_ping_main(AF_INET6, argv);
927# else
928 return common_ping_main(OPT_IPV6, argv);
929# endif
Denis Vlasenkob9a279b2007-01-24 23:53:22 +0000930}
931#endif
932
933/* from ping6.c:
934 * Copyright (c) 1989 The Regents of the University of California.
935 * All rights reserved.
936 *
937 * This code is derived from software contributed to Berkeley by
938 * Mike Muuss.
939 *
940 * Redistribution and use in source and binary forms, with or without
941 * modification, are permitted provided that the following conditions
942 * are met:
943 * 1. Redistributions of source code must retain the above copyright
944 * notice, this list of conditions and the following disclaimer.
945 * 2. Redistributions in binary form must reproduce the above copyright
946 * notice, this list of conditions and the following disclaimer in the
947 * documentation and/or other materials provided with the distribution.
948 *
949 * 3. <BSD Advertising Clause omitted per the July 22, 1999 licensing change
950 * ftp://ftp.cs.berkeley.edu/pub/4bsd/README.Impt.License.Change>
951 *
952 * 4. Neither the name of the University nor the names of its contributors
953 * may be used to endorse or promote products derived from this software
954 * without specific prior written permission.
955 *
956 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
957 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
958 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
959 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
960 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
961 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
962 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
963 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
964 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
965 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
966 * SUCH DAMAGE.
967 */