1 /* vi: set sw=4 ts=4: */
3 * $Id: ping.c,v 1.48 2002/02/01 16:54:00 kraai Exp $
4 * Mini ping implementation for busybox
6 * Copyright (C) 1999 by Randolph Chung <tausq@debian.org>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22 * This version of ping is adapted from the ping in netkit-base 0.10,
25 * Copyright (c) 1989 The Regents of the University of California.
26 * All rights reserved.
28 * This code is derived from software contributed to Berkeley by
31 * Original copyright notice is retained at the end of this file.
34 #include <sys/param.h>
35 #include <sys/socket.h>
38 #include <sys/times.h>
39 #include <sys/signal.h>
41 #include <netinet/in.h>
42 #include <netinet/ip.h>
43 #include <netinet/ip_icmp.h>
44 #include <arpa/inet.h>
55 /* It turns out that libc5 doesn't have proper icmp support
56 * built into it header files, so we have to supplement it */
57 #if __GNU_LIBRARY__ < 5
58 static const int ICMP_MINLEN = 8; /* abs minimum */
63 u_int32_t ira_preference;
69 u_int8_t icmp_type; /* type of message, see below */
70 u_int8_t icmp_code; /* type sub code */
71 u_int16_t icmp_cksum; /* ones complement checksum of struct */
74 u_char ih_pptr; /* ICMP_PARAMPROB */
75 struct in_addr ih_gwaddr; /* gateway address */
76 struct ih_idseq /* echo datagram */
83 /* ICMP_UNREACH_NEEDFRAG -- Path MTU Discovery (RFC1191) */
87 u_int16_t ipm_nextmtu;
92 u_int8_t irt_num_addrs;
94 u_int16_t irt_lifetime;
97 #define icmp_pptr icmp_hun.ih_pptr
98 #define icmp_gwaddr icmp_hun.ih_gwaddr
99 #define icmp_id icmp_hun.ih_idseq.icd_id
100 #define icmp_seq icmp_hun.ih_idseq.icd_seq
101 #define icmp_void icmp_hun.ih_void
102 #define icmp_pmvoid icmp_hun.ih_pmtu.ipm_void
103 #define icmp_nextmtu icmp_hun.ih_pmtu.ipm_nextmtu
104 #define icmp_num_addrs icmp_hun.ih_rtradv.irt_num_addrs
105 #define icmp_wpa icmp_hun.ih_rtradv.irt_wpa
106 #define icmp_lifetime icmp_hun.ih_rtradv.irt_lifetime
118 /* options and then 64 bits of data */
120 struct icmp_ra_addr id_radv;
124 #define icmp_otime icmp_dun.id_ts.its_otime
125 #define icmp_rtime icmp_dun.id_ts.its_rtime
126 #define icmp_ttime icmp_dun.id_ts.its_ttime
127 #define icmp_ip icmp_dun.id_ip.idi_ip
128 #define icmp_radv icmp_dun.id_radv
129 #define icmp_mask icmp_dun.id_mask
130 #define icmp_data icmp_dun.id_data
134 static const int DEFDATALEN = 56;
135 static const int MAXIPLEN = 60;
136 static const int MAXICMPLEN = 76;
137 static const int MAXPACKET = 65468;
138 #define MAX_DUP_CHK (8 * 128)
139 static const int MAXWAIT = 10;
140 static const int PINGINTERVAL = 1; /* second */
142 #define O_QUIET (1 << 0)
144 #define A(bit) rcvd_tbl[(bit)>>3] /* identify byte in array */
145 #define B(bit) (1 << ((bit) & 0x07)) /* identify bit in byte */
146 #define SET(bit) (A(bit) |= B(bit))
147 #define CLR(bit) (A(bit) &= (~B(bit)))
148 #define TST(bit) (A(bit) & B(bit))
150 static void ping(const char *host);
152 /* common routines */
153 static int in_cksum(unsigned short *buf, int sz)
157 unsigned short *w = buf;
158 unsigned short ans = 0;
166 *(unsigned char *) (&ans) = *(unsigned char *) w;
170 sum = (sum >> 16) + (sum & 0xFFFF);
177 #ifndef CONFIG_FEATURE_FANCY_PING
179 static void ping(const char *host)
182 struct sockaddr_in pingaddr;
185 char packet[DEFDATALEN + MAXIPLEN + MAXICMPLEN];
189 printf("No response from %s\n", h->h_name);
193 pingsock = create_icmp_socket();
195 memset(&pingaddr, 0, sizeof(struct sockaddr_in));
197 pingaddr.sin_family = AF_INET;
198 h = xgethostbyname(host);
199 memcpy(&pingaddr.sin_addr, h->h_addr, sizeof(pingaddr.sin_addr));
201 pkt = (struct icmp *) packet;
202 memset(pkt, 0, sizeof(packet));
203 pkt->icmp_type = ICMP_ECHO;
204 pkt->icmp_cksum = in_cksum((unsigned short *) pkt, sizeof(packet));
206 c = sendto(pingsock, packet, sizeof(packet), 0,
207 (struct sockaddr *) &pingaddr, sizeof(struct sockaddr_in));
209 if (c < 0 || c != sizeof(packet))
210 perror_msg_and_die("sendto");
212 signal(SIGALRM, noresp);
213 alarm(5); /* give the host 5000ms to respond */
214 /* listen for replies */
216 struct sockaddr_in from;
217 size_t fromlen = sizeof(from);
219 if ((c = recvfrom(pingsock, packet, sizeof(packet), 0,
220 (struct sockaddr *) &from, &fromlen)) < 0) {
223 perror_msg("recvfrom");
226 if (c >= 76) { /* ip + icmp */
227 struct iphdr *iphdr = (struct iphdr *) packet;
229 pkt = (struct icmp *) (packet + (iphdr->ihl << 2)); /* skip ip hdr */
230 if (pkt->icmp_type == ICMP_ECHOREPLY)
234 printf("%s is alive!\n", h->h_name);
238 extern int ping_main(int argc, char **argv)
248 #else /* ! CONFIG_FEATURE_FANCY_PING */
249 /* full(er) version */
250 static struct sockaddr_in pingaddr;
251 static int pingsock = -1;
252 static int datalen; /* intentionally uninitialized to work around gcc bug */
254 static long ntransmitted, nreceived, nrepeats, pingcount;
255 static int myid, options;
256 static unsigned long tmin = ULONG_MAX, tmax, tsum;
257 static char rcvd_tbl[MAX_DUP_CHK / 8];
259 struct hostent *hostent;
261 static void sendping(int);
262 static void pingstats(int);
263 static void unpack(char *, int, struct sockaddr_in *);
265 /**************************************************************************/
267 static void pingstats(int junk)
271 signal(SIGINT, SIG_IGN);
273 printf("\n--- %s ping statistics ---\n", hostent->h_name);
274 printf("%ld packets transmitted, ", ntransmitted);
275 printf("%ld packets received, ", nreceived);
277 printf("%ld duplicates, ", nrepeats);
279 printf("%ld%% packet loss\n",
280 (ntransmitted - nreceived) * 100 / ntransmitted);
282 printf("round-trip min/avg/max = %lu.%lu/%lu.%lu/%lu.%lu ms\n",
283 tmin / 10, tmin % 10,
284 (tsum / (nreceived + nrepeats)) / 10,
285 (tsum / (nreceived + nrepeats)) % 10, tmax / 10, tmax % 10);
287 status = EXIT_SUCCESS;
289 status = EXIT_FAILURE;
293 static void sendping(int junk)
297 char packet[datalen + 8];
299 pkt = (struct icmp *) packet;
301 pkt->icmp_type = ICMP_ECHO;
304 pkt->icmp_seq = ntransmitted++;
306 CLR(pkt->icmp_seq % MAX_DUP_CHK);
308 gettimeofday((struct timeval *) &packet[8], NULL);
309 pkt->icmp_cksum = in_cksum((unsigned short *) pkt, sizeof(packet));
311 i = sendto(pingsock, packet, sizeof(packet), 0,
312 (struct sockaddr *) &pingaddr, sizeof(struct sockaddr_in));
315 perror_msg_and_die("sendto");
316 else if ((size_t)i != sizeof(packet))
317 error_msg_and_die("ping wrote %d chars; %d expected", i,
318 (int)sizeof(packet));
320 signal(SIGALRM, sendping);
321 if (pingcount == 0 || ntransmitted < pingcount) { /* schedule next in 1s */
323 } else { /* done, wait for the last ping to come back */
324 /* todo, don't necessarily need to wait so long... */
325 signal(SIGALRM, pingstats);
330 static char *icmp_type_name (int id)
333 case ICMP_ECHOREPLY: return "Echo Reply";
334 case ICMP_DEST_UNREACH: return "Destination Unreachable";
335 case ICMP_SOURCE_QUENCH: return "Source Quench";
336 case ICMP_REDIRECT: return "Redirect (change route)";
337 case ICMP_ECHO: return "Echo Request";
338 case ICMP_TIME_EXCEEDED: return "Time Exceeded";
339 case ICMP_PARAMETERPROB: return "Parameter Problem";
340 case ICMP_TIMESTAMP: return "Timestamp Request";
341 case ICMP_TIMESTAMPREPLY: return "Timestamp Reply";
342 case ICMP_INFO_REQUEST: return "Information Request";
343 case ICMP_INFO_REPLY: return "Information Reply";
344 case ICMP_ADDRESS: return "Address Mask Request";
345 case ICMP_ADDRESSREPLY: return "Address Mask Reply";
346 default: return "unknown ICMP type";
350 static void unpack(char *buf, int sz, struct sockaddr_in *from)
352 struct icmp *icmppkt;
354 struct timeval tv, *tp;
356 unsigned long triptime;
358 gettimeofday(&tv, NULL);
360 /* check IP header */
361 iphdr = (struct iphdr *) buf;
362 hlen = iphdr->ihl << 2;
363 /* discard if too short */
364 if (sz < (datalen + ICMP_MINLEN))
368 icmppkt = (struct icmp *) (buf + hlen);
370 if (icmppkt->icmp_id != myid)
371 return; /* not our ping */
373 if (icmppkt->icmp_type == ICMP_ECHOREPLY) {
375 tp = (struct timeval *) icmppkt->icmp_data;
377 if ((tv.tv_usec -= tp->tv_usec) < 0) {
379 tv.tv_usec += 1000000;
381 tv.tv_sec -= tp->tv_sec;
383 triptime = tv.tv_sec * 10000 + (tv.tv_usec / 100);
390 if (TST(icmppkt->icmp_seq % MAX_DUP_CHK)) {
395 SET(icmppkt->icmp_seq % MAX_DUP_CHK);
399 if (options & O_QUIET)
402 printf("%d bytes from %s: icmp_seq=%u", sz,
403 inet_ntoa(*(struct in_addr *) &from->sin_addr.s_addr),
405 printf(" ttl=%d", iphdr->ttl);
406 printf(" time=%lu.%lu ms", triptime / 10, triptime % 10);
411 if (icmppkt->icmp_type != ICMP_ECHO)
412 error_msg("Warning: Got ICMP %d (%s)",
413 icmppkt->icmp_type, icmp_type_name (icmppkt->icmp_type));
416 static void ping(const char *host)
418 char packet[datalen + MAXIPLEN + MAXICMPLEN];
421 pingsock = create_icmp_socket();
423 memset(&pingaddr, 0, sizeof(struct sockaddr_in));
425 pingaddr.sin_family = AF_INET;
426 hostent = xgethostbyname(host);
427 if (hostent->h_addrtype != AF_INET)
428 error_msg_and_die("unknown address type; only AF_INET is currently supported.");
430 memcpy(&pingaddr.sin_addr, hostent->h_addr, sizeof(pingaddr.sin_addr));
432 /* enable broadcast pings */
434 setsockopt(pingsock, SOL_SOCKET, SO_BROADCAST, (char *) &sockopt,
437 /* set recv buf for broadcast pings */
439 setsockopt(pingsock, SOL_SOCKET, SO_RCVBUF, (char *) &sockopt,
442 printf("PING %s (%s): %d data bytes\n",
444 inet_ntoa(*(struct in_addr *) &pingaddr.sin_addr.s_addr),
447 signal(SIGINT, pingstats);
449 /* start the ping's going ... */
452 /* listen for replies */
454 struct sockaddr_in from;
455 socklen_t fromlen = (socklen_t) sizeof(from);
458 if ((c = recvfrom(pingsock, packet, sizeof(packet), 0,
459 (struct sockaddr *) &from, &fromlen)) < 0) {
462 perror_msg("recvfrom");
465 unpack(packet, c, &from);
466 if (pingcount > 0 && nreceived >= pingcount)
472 extern int ping_main(int argc, char **argv)
476 datalen = DEFDATALEN; /* initialized here rather than in global scope to work around gcc bug */
481 /* Parse any options */
482 while (argc >= 1 && **argv == '-') {
493 pingcount = atoi(*argv);
499 datalen = atoi(*argv);
510 myid = getpid() & 0xFFFF;
514 #endif /* ! CONFIG_FEATURE_FANCY_PING */
517 * Copyright (c) 1989 The Regents of the University of California.
518 * All rights reserved.
520 * This code is derived from software contributed to Berkeley by
523 * Redistribution and use in source and binary forms, with or without
524 * modification, are permitted provided that the following conditions
526 * 1. Redistributions of source code must retain the above copyright
527 * notice, this list of conditions and the following disclaimer.
528 * 2. Redistributions in binary form must reproduce the above copyright
529 * notice, this list of conditions and the following disclaimer in the
530 * documentation and/or other materials provided with the distribution.
532 * 3. <BSD Advertising Clause omitted per the July 22, 1999 licensing change
533 * ftp://ftp.cs.berkeley.edu/pub/4bsd/README.Impt.License.Change>
535 * 4. Neither the name of the University nor the names of its contributors
536 * may be used to endorse or promote products derived from this software
537 * without specific prior written permission.
539 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
540 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
541 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
542 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
543 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
544 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
545 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
546 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
547 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
548 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF