Home | History | Annotate | Line # | Download | only in ping6
ping6.c revision 1.6
      1  1.6   itojun /*	$NetBSD: ping6.c,v 1.6 1999/07/04 02:46:28 itojun Exp $	*/
      2  1.6   itojun 
      3  1.1   itojun /*
      4  1.1   itojun  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      5  1.1   itojun  * All rights reserved.
      6  1.1   itojun  *
      7  1.1   itojun  * Redistribution and use in source and binary forms, with or without
      8  1.1   itojun  * modification, are permitted provided that the following conditions
      9  1.1   itojun  * are met:
     10  1.1   itojun  * 1. Redistributions of source code must retain the above copyright
     11  1.1   itojun  *    notice, this list of conditions and the following disclaimer.
     12  1.1   itojun  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1   itojun  *    notice, this list of conditions and the following disclaimer in the
     14  1.1   itojun  *    documentation and/or other materials provided with the distribution.
     15  1.1   itojun  * 3. Neither the name of the project nor the names of its contributors
     16  1.1   itojun  *    may be used to endorse or promote products derived from this software
     17  1.1   itojun  *    without specific prior written permission.
     18  1.1   itojun  *
     19  1.1   itojun  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     20  1.1   itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21  1.1   itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22  1.1   itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     23  1.1   itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24  1.1   itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25  1.1   itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26  1.1   itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27  1.1   itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28  1.1   itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29  1.1   itojun  * SUCH DAMAGE.
     30  1.1   itojun  */
     31  1.1   itojun 
     32  1.1   itojun /*	BSDI	ping.c,v 2.3 1996/01/21 17:56:50 jch Exp	*/
     33  1.1   itojun 
     34  1.1   itojun /*
     35  1.1   itojun  * Copyright (c) 1989, 1993
     36  1.1   itojun  *	The Regents of the University of California.  All rights reserved.
     37  1.1   itojun  *
     38  1.1   itojun  * This code is derived from software contributed to Berkeley by
     39  1.1   itojun  * Mike Muuss.
     40  1.1   itojun  *
     41  1.1   itojun  * Redistribution and use in source and binary forms, with or without
     42  1.1   itojun  * modification, are permitted provided that the following conditions
     43  1.1   itojun  * are met:
     44  1.1   itojun  * 1. Redistributions of source code must retain the above copyright
     45  1.1   itojun  *    notice, this list of conditions and the following disclaimer.
     46  1.1   itojun  * 2. Redistributions in binary form must reproduce the above copyright
     47  1.1   itojun  *    notice, this list of conditions and the following disclaimer in the
     48  1.1   itojun  *    documentation and/or other materials provided with the distribution.
     49  1.1   itojun  * 3. All advertising materials mentioning features or use of this software
     50  1.1   itojun  *    must display the following acknowledgement:
     51  1.1   itojun  *	This product includes software developed by the University of
     52  1.1   itojun  *	California, Berkeley and its contributors.
     53  1.1   itojun  * 4. Neither the name of the University nor the names of its contributors
     54  1.1   itojun  *    may be used to endorse or promote products derived from this software
     55  1.1   itojun  *    without specific prior written permission.
     56  1.1   itojun  *
     57  1.1   itojun  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     58  1.1   itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     59  1.1   itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     60  1.1   itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     61  1.1   itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     62  1.1   itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     63  1.1   itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     64  1.1   itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     65  1.1   itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     66  1.1   itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     67  1.1   itojun  * SUCH DAMAGE.
     68  1.1   itojun  */
     69  1.1   itojun 
     70  1.4   itojun #if 0
     71  1.1   itojun #ifndef lint
     72  1.6   itojun static char copyright[] =
     73  1.1   itojun "@(#) Copyright (c) 1989, 1993\n\
     74  1.6   itojun 	The Regents of the University of California.  All rights reserved.\n";
     75  1.6   itojun #endif /* not lint */
     76  1.6   itojun 
     77  1.6   itojun #ifndef lint
     78  1.6   itojun static char sccsid[] = "@(#)ping.c	8.1 (Berkeley) 6/5/93";
     79  1.1   itojun #endif /* not lint */
     80  1.6   itojun #else
     81  1.6   itojun #include <sys/cdefs.h>
     82  1.6   itojun #ifndef lint
     83  1.6   itojun __RCSID("$NetBSD");
     84  1.4   itojun #endif
     85  1.1   itojun #endif
     86  1.1   itojun 
     87  1.1   itojun /*
     88  1.1   itojun  * Using the InterNet Control Message Protocol (ICMP) "ECHO" facility,
     89  1.1   itojun  * measure round-trip-delays and packet loss across network paths.
     90  1.1   itojun  *
     91  1.1   itojun  * Author -
     92  1.1   itojun  *	Mike Muuss
     93  1.1   itojun  *	U. S. Army Ballistic Research Laboratory
     94  1.1   itojun  *	December, 1983
     95  1.1   itojun  *
     96  1.1   itojun  * Status -
     97  1.1   itojun  *	Public Domain.  Distribution Unlimited.
     98  1.1   itojun  * Bugs -
     99  1.1   itojun  *	More statistics could always be gathered.
    100  1.1   itojun  *	This program has to run SUID to ROOT to access the ICMP socket.
    101  1.1   itojun  */
    102  1.1   itojun 
    103  1.1   itojun #include <sys/param.h>
    104  1.1   itojun #include <sys/uio.h>
    105  1.1   itojun #include <sys/socket.h>
    106  1.1   itojun #include <sys/time.h>
    107  1.1   itojun 
    108  1.1   itojun #include <net/if.h>
    109  1.1   itojun #include <net/route.h>
    110  1.1   itojun 
    111  1.1   itojun #include <netinet/in_systm.h>
    112  1.1   itojun #include <netinet/in.h>
    113  1.1   itojun #include <netinet/ip.h>
    114  1.1   itojun #include <netinet/ip_var.h>
    115  1.1   itojun #include <netinet/ip6.h>
    116  1.1   itojun #include <netinet/icmp6.h>
    117  1.1   itojun #include <netinet6/ah.h>
    118  1.1   itojun #include <arpa/inet.h>
    119  1.1   itojun #include <netdb.h>
    120  1.1   itojun 
    121  1.1   itojun #include <ctype.h>
    122  1.1   itojun #include <err.h>
    123  1.1   itojun #include <errno.h>
    124  1.1   itojun #include <fcntl.h>
    125  1.1   itojun #include <signal.h>
    126  1.1   itojun #include <stdio.h>
    127  1.1   itojun #include <stdlib.h>
    128  1.1   itojun #include <string.h>
    129  1.1   itojun #include <unistd.h>
    130  1.1   itojun 
    131  1.1   itojun #ifdef IPSEC
    132  1.1   itojun #include <netinet6/ipsec.h>
    133  1.1   itojun #endif
    134  1.1   itojun 
    135  1.1   itojun #define MAXPACKETLEN	131072
    136  1.1   itojun #define	IP6LEN		40
    137  1.1   itojun #define ICMP6ECHOLEN	8	/* icmp echo header len excluding time */
    138  1.1   itojun #define ICMP6ECHOTMLEN sizeof(struct timeval)
    139  1.1   itojun #define ICMP6_NIQLEN	(ICMP6ECHOLEN + 8)
    140  1.1   itojun #define ICMP6_NIRLEN	(ICMP6ECHOLEN + 12) /* 64 bits of nonce + 32 bits ttl */
    141  1.1   itojun #define	EXTRA		256	/* for AH and various other headers. weird. */
    142  1.1   itojun #define	DEFDATALEN	ICMP6ECHOTMLEN
    143  1.1   itojun #define MAXDATALEN	MAXPACKETLEN - IP6LEN - ICMP6ECHOLEN
    144  1.1   itojun #define	NROUTES		9		/* number of record route slots */
    145  1.1   itojun 
    146  1.1   itojun #define	A(bit)		rcvd_tbl[(bit)>>3]	/* identify byte in array */
    147  1.1   itojun #define	B(bit)		(1 << ((bit) & 0x07))	/* identify bit in byte */
    148  1.1   itojun #define	SET(bit)	(A(bit) |= B(bit))
    149  1.1   itojun #define	CLR(bit)	(A(bit) &= (~B(bit)))
    150  1.1   itojun #define	TST(bit)	(A(bit) & B(bit))
    151  1.1   itojun 
    152  1.1   itojun #define	F_FLOOD		0x0001
    153  1.1   itojun #define	F_INTERVAL	0x0002
    154  1.1   itojun #define	F_NUMERIC	0x0004
    155  1.1   itojun #define	F_PINGFILLED	0x0008
    156  1.1   itojun #define	F_QUIET		0x0010
    157  1.1   itojun #define	F_RROUTE	0x0020
    158  1.1   itojun #define	F_SO_DEBUG	0x0040
    159  1.1   itojun #define	F_VERBOSE	0x0100
    160  1.1   itojun #ifdef IPSEC
    161  1.1   itojun #ifdef IPSEC_POLICY_IPSEC
    162  1.1   itojun #define	F_POLICY	0x4000
    163  1.1   itojun #else
    164  1.1   itojun #define F_AUTHHDR	0x0200
    165  1.1   itojun #define F_ENCRYPT	0x0400
    166  1.1   itojun #endif /*IPSEC_POLICY_IPSEC*/
    167  1.1   itojun #endif /*IPSEC*/
    168  1.1   itojun #define F_NODEADDR	0x0800
    169  1.1   itojun #define F_FQDN		0x1000
    170  1.1   itojun #define F_INTERFACE	0x2000
    171  1.1   itojun u_int options;
    172  1.1   itojun 
    173  1.1   itojun #define IN6LEN		sizeof(struct in6_addr)
    174  1.1   itojun #define SA6LEN		sizeof(struct sockaddr_in6)
    175  1.1   itojun #define DUMMY_PORT      10101
    176  1.1   itojun 
    177  1.1   itojun #define SIN6(s) ((struct sockaddr_in6 *)(s))
    178  1.1   itojun 
    179  1.1   itojun /*
    180  1.1   itojun  * MAX_DUP_CHK is the number of bits in received table, i.e. the maximum
    181  1.1   itojun  * number of received sequence numbers we can keep track of.  Change 128
    182  1.1   itojun  * to 8192 for complete accuracy...
    183  1.1   itojun  */
    184  1.1   itojun #define	MAX_DUP_CHK	(8 * 8192)
    185  1.1   itojun int mx_dup_ck = MAX_DUP_CHK;
    186  1.1   itojun char rcvd_tbl[MAX_DUP_CHK / 8];
    187  1.1   itojun 
    188  1.1   itojun struct addrinfo *res;
    189  1.1   itojun struct sockaddr_in6 dst;        /* who to ping6 */
    190  1.1   itojun struct sockaddr_in6 src;        /* src addr of this packet */
    191  1.1   itojun int datalen = DEFDATALEN;
    192  1.1   itojun int s;				/* socket file descriptor */
    193  1.1   itojun u_char outpack[MAXPACKETLEN];
    194  1.1   itojun char BSPACE = '\b';		/* characters written for flood */
    195  1.1   itojun char DOT = '.';
    196  1.1   itojun char *hostname;
    197  1.1   itojun int ident;			/* process id to identify our packets */
    198  1.1   itojun 
    199  1.1   itojun /* counters */
    200  1.1   itojun long npackets;			/* max packets to transmit */
    201  1.1   itojun long nreceived;			/* # of packets we got back */
    202  1.1   itojun long nrepeats;			/* number of duplicates */
    203  1.1   itojun long ntransmitted;		/* sequence # for outbound packets = #sent */
    204  1.1   itojun int interval = 1;		/* interval between packets */
    205  1.1   itojun int hoplimit = -1;		/* hoplimit */
    206  1.1   itojun 
    207  1.1   itojun /* timing */
    208  1.1   itojun int timing;			/* flag to do timing */
    209  1.1   itojun double tmin = 999999999.0;	/* minimum round trip time */
    210  1.1   itojun double tmax = 0.0;		/* maximum round trip time */
    211  1.1   itojun double tsum = 0.0;		/* sum of all times, for doing average */
    212  1.1   itojun 
    213  1.1   itojun /* for inet_ntop() */
    214  1.1   itojun char ntop_buf[INET6_ADDRSTRLEN];
    215  1.1   itojun 
    216  1.1   itojun /* for node addresses */
    217  1.1   itojun u_short naflags;
    218  1.1   itojun 
    219  1.1   itojun /* for ancillary data(advanced API) */
    220  1.1   itojun struct msghdr smsghdr;
    221  1.1   itojun struct iovec smsgiov;
    222  1.1   itojun char *scmsg = 0;
    223  1.1   itojun 
    224  1.1   itojun int	 main __P((int, char *[]));
    225  1.1   itojun void	 fill __P((char *, char *));
    226  1.1   itojun int	 get_hoplim __P((struct msghdr *));
    227  1.1   itojun void	 onalrm __P((int));
    228  1.1   itojun void	 oninfo __P((int));
    229  1.1   itojun void	 onint __P((int));
    230  1.1   itojun void	 pinger __P((void));
    231  1.1   itojun char	*pr_addr __P((struct in6_addr *));
    232  1.1   itojun void	 pr_icmph __P((struct icmp6_hdr *, u_char *));
    233  1.1   itojun void	 pr_iph __P((struct ip6_hdr *));
    234  1.1   itojun void	 pr_nodeaddr __P((struct icmp6_nodeinfo *, int));
    235  1.1   itojun void	 pr_pack __P((u_char *, int, struct msghdr *));
    236  1.1   itojun void	 pr_retip __P((struct ip6_hdr *, u_char *));
    237  1.1   itojun void	 summary __P((void));
    238  1.1   itojun void	 tvsub __P((struct timeval *, struct timeval *));
    239  1.1   itojun void	 usage __P((void));
    240  1.1   itojun 
    241  1.1   itojun int
    242  1.1   itojun main(argc, argv)
    243  1.1   itojun 	int argc;
    244  1.1   itojun 	char *argv[];
    245  1.1   itojun {
    246  1.1   itojun 	extern int errno, optind;
    247  1.1   itojun 	extern char *optarg;
    248  1.1   itojun 	struct itimerval itimer;
    249  1.1   itojun 	struct sockaddr_in6 from;
    250  1.1   itojun 	struct timeval timeout;
    251  1.1   itojun 	struct addrinfo hints;
    252  1.1   itojun 	fd_set fdset;
    253  1.1   itojun 	register int cc, i;
    254  1.1   itojun 	int ch, fromlen, hold, packlen, preload, optval, ret_ga;
    255  1.1   itojun 	u_char *datap, *packet;
    256  1.1   itojun 	char *e, *target, *ifname = NULL;
    257  1.1   itojun 	int ip6optlen = 0;
    258  1.1   itojun 	struct cmsghdr *scmsgp = NULL;
    259  1.1   itojun 	int sockbufsize = 0;
    260  1.1   itojun #ifdef IPSEC_POLICY_IPSEC
    261  1.1   itojun 	char *policy = NULL;
    262  1.1   itojun #endif
    263  1.1   itojun 
    264  1.1   itojun 	/* just to be sure */
    265  1.1   itojun 	memset(&smsghdr, 0, sizeof(&smsghdr));
    266  1.1   itojun 	memset(&smsgiov, 0, sizeof(&smsgiov));
    267  1.1   itojun 
    268  1.1   itojun 	preload = 0;
    269  1.1   itojun 	datap = &outpack[ICMP6ECHOLEN + ICMP6ECHOTMLEN];
    270  1.1   itojun #ifndef IPSEC
    271  1.1   itojun 	while ((ch = getopt(argc, argv, "a:b:c:dfh:I:i:l:np:qRrs:vwW")) != EOF)
    272  1.1   itojun #else
    273  1.1   itojun #ifdef IPSEC_POLICY_IPSEC
    274  1.1   itojun 	while ((ch = getopt(argc, argv, "a:b:c:dfh:I:i:l:np:qRrs:vwWP:")) != EOF)
    275  1.1   itojun #else
    276  1.1   itojun 	while ((ch = getopt(argc, argv, "a:b:c:dfh:I:i:l:np:qRrs:vwWAE")) != EOF)
    277  1.1   itojun #endif /*IPSEC_POLICY_IPSEC*/
    278  1.1   itojun #endif
    279  1.1   itojun 		switch(ch) {
    280  1.1   itojun 		 case 'a':
    281  1.1   itojun 		 {
    282  1.1   itojun 			 u_char *cp;
    283  1.1   itojun 
    284  1.1   itojun 			 options |= F_NODEADDR;
    285  1.1   itojun 			 datalen = 2048; /* XXX: enough? */
    286  1.1   itojun 			 for (cp = optarg; *cp != '\0'; cp++) {
    287  1.1   itojun 				 switch(*cp) {
    288  1.1   itojun 				  case 'a':
    289  1.1   itojun 				  case 'A':
    290  1.1   itojun 					  naflags |= NI_NODEADDR_FLAG_ALL;
    291  1.1   itojun 					  break;
    292  1.1   itojun 				  case 'l':
    293  1.1   itojun 				  case 'L':
    294  1.1   itojun 					  naflags |= NI_NODEADDR_FLAG_LINKLOCAL;
    295  1.1   itojun 					  break;
    296  1.1   itojun 				  case 's':
    297  1.1   itojun 				  case 'S':
    298  1.1   itojun 					  naflags |= NI_NODEADDR_FLAG_SITELOCAL;
    299  1.1   itojun 					  break;
    300  1.1   itojun 				  case 'g':
    301  1.1   itojun 				  case 'G':
    302  1.1   itojun 					  naflags |= NI_NODEADDR_FLAG_GLOBAL;
    303  1.1   itojun 					  break;
    304  1.1   itojun 				  default:
    305  1.1   itojun 					  usage();
    306  1.1   itojun 				 }
    307  1.1   itojun 			 }
    308  1.1   itojun 			 break;
    309  1.1   itojun 		 }
    310  1.1   itojun 		 case 'b':
    311  1.1   itojun #if defined(SO_SNDBUF) && defined(SO_RCVBUF)
    312  1.1   itojun 			sockbufsize = atoi(optarg);
    313  1.1   itojun #else
    314  1.1   itojun 			err(1,
    315  1.1   itojun "-b option ignored: SO_SNDBUF/SO_RCVBUF socket options not supported");
    316  1.1   itojun #endif
    317  1.1   itojun 			break;
    318  1.1   itojun 		case 'c':
    319  1.1   itojun 			npackets = strtol(optarg, &e, 10);
    320  1.1   itojun 			if (npackets <= 0 || *optarg == '\0' || *e != '\0')
    321  1.1   itojun 				errx(1,
    322  1.1   itojun 				    "illegal number of packets -- %s", optarg);
    323  1.1   itojun 			break;
    324  1.1   itojun 		case 'd':
    325  1.1   itojun 			options |= F_SO_DEBUG;
    326  1.1   itojun 			break;
    327  1.1   itojun 		case 'f':
    328  1.1   itojun 			if (getuid()) {
    329  1.1   itojun 				errno = EPERM;
    330  1.3  thorpej 				errx(1, "Must be superuser to flood ping");
    331  1.1   itojun 			}
    332  1.1   itojun 			options |= F_FLOOD;
    333  1.1   itojun 			setbuf(stdout, (char *)NULL);
    334  1.1   itojun 			break;
    335  1.1   itojun 		case 'h':		/* hoplimit */
    336  1.1   itojun 			hoplimit = strtol(optarg, &e, 10);
    337  1.1   itojun 			if (255 < hoplimit || hoplimit < -1)
    338  1.1   itojun 				errx(1,
    339  1.1   itojun 				    "illegal hoplimit -- %s", optarg);
    340  1.1   itojun 			break;
    341  1.1   itojun 		case 'I':
    342  1.1   itojun 			ifname = optarg;
    343  1.1   itojun 			options |= F_INTERFACE;
    344  1.1   itojun 			break;
    345  1.1   itojun 		case 'i':		/* wait between sending packets */
    346  1.1   itojun 			interval = strtol(optarg, &e, 10);
    347  1.1   itojun 			if (interval <= 0 || *optarg == '\0' || *e != '\0')
    348  1.1   itojun 				errx(1,
    349  1.1   itojun 				    "illegal timing interval -- %s", optarg);
    350  1.1   itojun 			options |= F_INTERVAL;
    351  1.1   itojun 			break;
    352  1.1   itojun 		case 'l':
    353  1.1   itojun 			preload = strtol(optarg, &e, 10);
    354  1.1   itojun 			if (preload < 0 || *optarg == '\0' || *e != '\0')
    355  1.1   itojun 				errx(1, "illegal preload value -- %s", optarg);
    356  1.1   itojun 			break;
    357  1.1   itojun 		case 'n':
    358  1.1   itojun 			options |= F_NUMERIC;
    359  1.1   itojun 			break;
    360  1.1   itojun 		case 'p':		/* fill buffer with user pattern */
    361  1.1   itojun 			options |= F_PINGFILLED;
    362  1.1   itojun 			fill((char *)datap, optarg);
    363  1.1   itojun 				break;
    364  1.1   itojun 		case 'q':
    365  1.1   itojun 			options |= F_QUIET;
    366  1.1   itojun 			break;
    367  1.1   itojun 		case 'R':
    368  1.1   itojun 			options |= F_RROUTE;
    369  1.1   itojun 			break;
    370  1.1   itojun 		case 's':		/* size of packet to send */
    371  1.1   itojun 			datalen = strtol(optarg, &e, 10);
    372  1.1   itojun 			if (datalen <= 0 || *optarg == '\0' || *e != '\0')
    373  1.1   itojun 				errx(1, "illegal datalen value -- %s", optarg);
    374  1.1   itojun 			if (datalen > MAXDATALEN)
    375  1.1   itojun 				errx(1,
    376  1.1   itojun 				    "datalen value too large, maximum is %d",
    377  1.1   itojun 				    MAXDATALEN);
    378  1.1   itojun 			break;
    379  1.1   itojun 		case 'v':
    380  1.1   itojun 			options |= F_VERBOSE;
    381  1.1   itojun 			break;
    382  1.1   itojun 		case 'w':
    383  1.1   itojun 		case 'W':
    384  1.1   itojun 			options |= F_FQDN;
    385  1.1   itojun 			break;
    386  1.1   itojun #ifdef IPSEC
    387  1.1   itojun #ifdef IPSEC_POLICY_IPSEC
    388  1.1   itojun 		case 'P':
    389  1.1   itojun 			options |= F_POLICY;
    390  1.1   itojun 			policy = strdup(optarg);
    391  1.1   itojun 			break;
    392  1.1   itojun #else
    393  1.1   itojun 		case 'A':
    394  1.1   itojun 			options |= F_AUTHHDR;
    395  1.1   itojun 			break;
    396  1.1   itojun 		case 'E':
    397  1.1   itojun 			options |= F_ENCRYPT;
    398  1.1   itojun 			break;
    399  1.1   itojun #endif /*IPSEC_POLICY_IPSEC*/
    400  1.1   itojun #endif /*IPSEC*/
    401  1.1   itojun 		default:
    402  1.1   itojun 			usage();
    403  1.1   itojun 		}
    404  1.1   itojun 	argc -= optind;
    405  1.1   itojun 	argv += optind;
    406  1.1   itojun 
    407  1.1   itojun 	if (argc < 1)
    408  1.1   itojun 		usage();
    409  1.1   itojun 
    410  1.1   itojun 	if (argc > 1)
    411  1.1   itojun 		ip6optlen += inet6_rthdr_space(IPV6_RTHDR_TYPE_0, argc - 1);
    412  1.1   itojun 
    413  1.1   itojun 	target = argv[argc - 1];
    414  1.1   itojun 
    415  1.1   itojun 	/* getaddrinfo */
    416  1.1   itojun 	bzero(&hints, sizeof(struct addrinfo));
    417  1.1   itojun 	if ((options & F_NUMERIC) == 0)
    418  1.1   itojun 		hints.ai_flags = AI_CANONNAME;
    419  1.1   itojun 	hints.ai_family = AF_INET6;
    420  1.1   itojun 	hints.ai_socktype = SOCK_RAW;
    421  1.1   itojun 	hints.ai_protocol = IPPROTO_ICMPV6;
    422  1.1   itojun 
    423  1.1   itojun 	ret_ga = getaddrinfo(target, NULL, &hints, &res);
    424  1.1   itojun 	if (ret_ga) {
    425  1.1   itojun 		fprintf(stderr, "ping6: %s\n", gai_strerror(ret_ga));
    426  1.1   itojun 		exit(1);
    427  1.1   itojun 	}
    428  1.1   itojun 	if (res->ai_canonname)
    429  1.1   itojun 		hostname = res->ai_canonname;
    430  1.1   itojun 	else
    431  1.1   itojun 		hostname = target;
    432  1.1   itojun 
    433  1.1   itojun 	if (!res->ai_addr)
    434  1.1   itojun 		errx(1, "getaddrinfo failed");
    435  1.1   itojun 
    436  1.1   itojun 	(void)memcpy(&dst, res->ai_addr, res->ai_addrlen);
    437  1.1   itojun 
    438  1.1   itojun 	if (options & F_FLOOD && options & F_INTERVAL)
    439  1.1   itojun 		errx(1, "-f and -i incompatible options");
    440  1.1   itojun 
    441  1.1   itojun 	if (datalen >= sizeof(struct timeval))	/* can we time transfer */
    442  1.1   itojun 		timing = 1;
    443  1.1   itojun 	packlen = datalen + IP6LEN + ICMP6ECHOLEN + EXTRA;
    444  1.1   itojun 	if (!(packet = (u_char *)malloc((u_int)packlen)))
    445  1.3  thorpej 		err(1, "Unable to allocate packet");
    446  1.1   itojun 	if (!(options & F_PINGFILLED))
    447  1.1   itojun 		for (i = 8; i < datalen; ++i)
    448  1.1   itojun 			*datap++ = i;
    449  1.1   itojun 
    450  1.1   itojun 	ident = getpid() & 0xFFFF;
    451  1.1   itojun 
    452  1.1   itojun 	if ((s = socket(res->ai_family, res->ai_socktype, res->ai_protocol)) < 0)
    453  1.1   itojun 	  err(1, "socket");
    454  1.1   itojun 
    455  1.1   itojun 	hold = 1;
    456  1.1   itojun 
    457  1.1   itojun 	if (options & F_SO_DEBUG)
    458  1.1   itojun 		(void)setsockopt(s, SOL_SOCKET, SO_DEBUG, (char *)&hold,
    459  1.1   itojun 		    sizeof(hold));
    460  1.1   itojun 	optval = IPV6_DEFHLIM;
    461  1.1   itojun 	if (IN6_IS_ADDR_MULTICAST(&dst.sin6_addr))
    462  1.1   itojun 		if (setsockopt(s, IPPROTO_IPV6, IPV6_MULTICAST_HOPS,
    463  1.1   itojun 			       &optval, sizeof(optval)) == -1)
    464  1.1   itojun 			err(1, "IPV6_MULTICAST_HOPS");
    465  1.1   itojun 
    466  1.1   itojun #ifdef IPSEC
    467  1.1   itojun #ifdef IPSEC_POLICY_IPSEC
    468  1.1   itojun 	if (options & F_POLICY) {
    469  1.1   itojun 		int len;
    470  1.1   itojun 		char *buf;
    471  1.1   itojun 		if ((len = ipsec_get_policylen(policy)) < 0)
    472  1.1   itojun 			errx(1, ipsec_strerror());
    473  1.1   itojun 		if ((buf = malloc(len)) == NULL)
    474  1.1   itojun 			err(1, "malloc");
    475  1.1   itojun 		if ((len = ipsec_set_policy(buf, len, policy)) < 0)
    476  1.1   itojun 			errx(1, ipsec_strerror());
    477  1.1   itojun 		if (setsockopt(s, IPPROTO_IPV6, IPV6_IPSEC_POLICY, buf, len) < 0)
    478  1.5   itojun 			warnx("Unable to set IPSec policy");
    479  1.1   itojun 		free(buf);
    480  1.1   itojun 	}
    481  1.1   itojun #else
    482  1.1   itojun 	if (options & F_AUTHHDR) {
    483  1.1   itojun 		optval = IPSEC_LEVEL_REQUIRE;
    484  1.1   itojun #ifdef IPV6_AUTH_TRANS_LEVEL
    485  1.1   itojun 		if (setsockopt(s, IPPROTO_IPV6, IPV6_AUTH_TRANS_LEVEL,
    486  1.1   itojun 				&optval, sizeof(optval)) == -1)
    487  1.1   itojun 			err(1, "setsockopt(IPV6_AUTH_TRANS_LEVEL)");
    488  1.1   itojun #else /* old def */
    489  1.1   itojun 		if (setsockopt(s, IPPROTO_IPV6, IPV6_AUTH_LEVEL,
    490  1.1   itojun 				&optval, sizeof(optval)) == -1)
    491  1.1   itojun 			err(1, "setsockopt(IPV6_AUTH_LEVEL)");
    492  1.1   itojun #endif
    493  1.1   itojun 	}
    494  1.1   itojun 	if (options & F_ENCRYPT) {
    495  1.1   itojun 		optval = IPSEC_LEVEL_REQUIRE;
    496  1.1   itojun 		if (setsockopt(s, IPPROTO_IPV6, IPV6_ESP_TRANS_LEVEL,
    497  1.1   itojun 				&optval, sizeof(optval)) == -1)
    498  1.1   itojun 			err(1, "setsockopt(IPV6_ESP_TRANS_LEVEL)");
    499  1.1   itojun 	}
    500  1.1   itojun #endif /*IPSEC_POLICY_IPSEC*/
    501  1.1   itojun #endif
    502  1.1   itojun 
    503  1.1   itojun #ifdef ICMP6_FILTER
    504  1.1   itojun     {
    505  1.1   itojun 	struct icmp6_filter filt;
    506  1.1   itojun 	if (!(options & F_VERBOSE)) {
    507  1.1   itojun 		ICMP6_FILTER_SETBLOCKALL(&filt);
    508  1.1   itojun 		if ((options & F_FQDN) || (options & F_NODEADDR))
    509  1.1   itojun 			ICMP6_FILTER_SETPASS(ICMP6_NI_REPLY, &filt);
    510  1.1   itojun 		else
    511  1.1   itojun 			ICMP6_FILTER_SETPASS(ICMP6_ECHO_REPLY, &filt);
    512  1.1   itojun 	} else {
    513  1.1   itojun 		ICMP6_FILTER_SETPASSALL(&filt);
    514  1.1   itojun 	}
    515  1.1   itojun 	if (setsockopt(s, IPPROTO_ICMPV6, ICMP6_FILTER, &filt,
    516  1.1   itojun 			sizeof(filt)) < 0)
    517  1.1   itojun 		err(1, "setsockopt(ICMP6_FILTER)");
    518  1.1   itojun     }
    519  1.1   itojun #endif /*ICMP6_FILTER*/
    520  1.1   itojun 
    521  1.1   itojun /*
    522  1.1   itojun 	optval = 1;
    523  1.1   itojun 	if (IN6_IS_ADDR_MULTICAST(&dst.sin6_addr))
    524  1.1   itojun 		if (setsockopt(s, IPPROTO_IPV6, IPV6_MULTICAST_LOOP,
    525  1.1   itojun 			       &optval, sizeof(optval)) == -1)
    526  1.1   itojun 			err(1, "IPV6_MULTICAST_LOOP");
    527  1.1   itojun */
    528  1.1   itojun 	/* record route option */
    529  1.1   itojun 	if (options & F_RROUTE)
    530  1.1   itojun 		errx(1, "record route not available in this implementation");
    531  1.1   itojun 
    532  1.1   itojun 	/* Outgoing interface */
    533  1.1   itojun #ifndef SIN6_IFINDEX
    534  1.1   itojun 	if (options & F_INTERFACE)
    535  1.1   itojun 		ip6optlen += CMSG_SPACE(sizeof(struct in6_pktinfo));
    536  1.1   itojun #endif
    537  1.1   itojun 
    538  1.1   itojun 	if (hoplimit != -1)
    539  1.1   itojun 		ip6optlen += CMSG_SPACE(sizeof(int));
    540  1.1   itojun 
    541  1.1   itojun 	/* set IP6 packet options */
    542  1.1   itojun 	if (ip6optlen) {
    543  1.1   itojun 		if ((scmsg = (char *)malloc(ip6optlen)) == 0)
    544  1.1   itojun 			errx(1, "can't allocate enough memory");
    545  1.1   itojun 		smsghdr.msg_control = (caddr_t)scmsg;
    546  1.1   itojun 		smsghdr.msg_controllen = ip6optlen;
    547  1.1   itojun 		scmsgp = (struct cmsghdr *)scmsg;
    548  1.1   itojun 	}
    549  1.1   itojun 	if (options & F_INTERFACE) {
    550  1.1   itojun #ifndef SIN6_IFINDEX
    551  1.1   itojun 		struct in6_pktinfo *pktinfo =
    552  1.1   itojun 			(struct in6_pktinfo *)(CMSG_DATA(scmsgp));
    553  1.1   itojun 
    554  1.1   itojun 		if ((pktinfo->ipi6_ifindex = if_nametoindex(ifname)) == 0)
    555  1.1   itojun 			errx(1, "%s: invalid interface name", ifname);
    556  1.1   itojun 		bzero(&pktinfo->ipi6_addr, sizeof(struct in6_addr));
    557  1.1   itojun 		scmsgp->cmsg_len = CMSG_LEN(sizeof(struct in6_pktinfo));
    558  1.1   itojun 		scmsgp->cmsg_level = IPPROTO_IPV6;
    559  1.1   itojun 		scmsgp->cmsg_type = IPV6_PKTINFO;
    560  1.1   itojun 
    561  1.1   itojun 		scmsgp = CMSG_NXTHDR(&smsghdr, scmsgp);
    562  1.1   itojun #else
    563  1.1   itojun 		if ((dst.sin6_ifindex = if_nametoindex(ifname)) == 0)
    564  1.1   itojun 			errx(1, "%s: invalid interface name", ifname);
    565  1.1   itojun #endif
    566  1.1   itojun 	}
    567  1.1   itojun 	if (hoplimit != -1) {
    568  1.1   itojun 		scmsgp->cmsg_len = CMSG_LEN(sizeof(int));
    569  1.1   itojun 		scmsgp->cmsg_level = IPPROTO_IPV6;
    570  1.1   itojun 		scmsgp->cmsg_type = IPV6_HOPLIMIT;
    571  1.1   itojun 		*(int *)(CMSG_DATA(scmsgp)) = hoplimit;
    572  1.1   itojun 
    573  1.1   itojun 		scmsgp = CMSG_NXTHDR(&smsghdr, scmsgp);
    574  1.1   itojun 	}
    575  1.1   itojun 	if (argc > 1) {	/* some intermediate addrs are specified */
    576  1.1   itojun 		int hops, error;
    577  1.1   itojun 
    578  1.1   itojun 		if ((scmsgp = (struct cmsghdr *)inet6_rthdr_init(scmsgp,
    579  1.1   itojun 								 IPV6_RTHDR_TYPE_0)) == 0)
    580  1.1   itojun 			errx(1, "can't initialize rthdr");
    581  1.1   itojun 
    582  1.1   itojun 		for (hops = 0; hops < argc - 1; hops++) {
    583  1.1   itojun 			struct addrinfo *iaip;
    584  1.1   itojun 
    585  1.1   itojun 			if ((error = getaddrinfo(argv[hops], NULL, &hints, &iaip)))
    586  1.1   itojun 				errx(1, gai_strerror(error));
    587  1.1   itojun 			if (SIN6(res->ai_addr)->sin6_family != AF_INET6)
    588  1.1   itojun 				errx(1,
    589  1.1   itojun 				     "bad addr family of an intermediate addr");
    590  1.1   itojun 
    591  1.1   itojun 			if (inet6_rthdr_add(scmsgp,
    592  1.1   itojun 					    &(SIN6(iaip->ai_addr))->sin6_addr,
    593  1.1   itojun 					    IPV6_RTHDR_LOOSE))
    594  1.1   itojun 				errx(1, "can't add an intermediate node");
    595  1.1   itojun 		}
    596  1.1   itojun 
    597  1.1   itojun 		if (inet6_rthdr_lasthop(scmsgp, IPV6_RTHDR_LOOSE))
    598  1.1   itojun 			errx(1, "can't set the last flag");
    599  1.1   itojun 
    600  1.1   itojun 		scmsgp = CMSG_NXTHDR(&smsghdr, scmsgp);
    601  1.1   itojun 	}
    602  1.1   itojun 
    603  1.1   itojun 	{
    604  1.1   itojun 		/*
    605  1.1   itojun 		 * source selection
    606  1.1   itojun 		 */
    607  1.1   itojun 		int dummy, len = sizeof(src);
    608  1.1   itojun 
    609  1.1   itojun 		if ((dummy = socket(AF_INET6, SOCK_DGRAM, 0)) < 0)
    610  1.1   itojun 			err(1, "UDP socket");
    611  1.1   itojun 
    612  1.1   itojun 		src.sin6_family = AF_INET6;
    613  1.1   itojun 		src.sin6_addr = dst.sin6_addr;
    614  1.1   itojun 		src.sin6_port = ntohs(DUMMY_PORT);
    615  1.1   itojun 
    616  1.1   itojun #ifndef SIN6_IFINDEX
    617  1.1   itojun 		if (setsockopt(dummy, IPPROTO_IPV6, IPV6_PKTOPTIONS,
    618  1.1   itojun 			       (void *)smsghdr.msg_control,
    619  1.1   itojun 			       smsghdr.msg_controllen)) {
    620  1.1   itojun 			err(1, "UDP setsockopt");
    621  1.1   itojun 		}
    622  1.1   itojun #else
    623  1.1   itojun 		src.sin6_ifindex = dst.sin6_ifindex;
    624  1.1   itojun #endif
    625  1.1   itojun 
    626  1.1   itojun 		if (connect(dummy, (struct sockaddr *)&src, len) < 0)
    627  1.1   itojun 			err(1, "UDP connect");
    628  1.1   itojun 
    629  1.1   itojun 		if (getsockname(dummy, (struct sockaddr *)&src, &len) < 0)
    630  1.1   itojun 			err(1, "getsockname");
    631  1.1   itojun 
    632  1.1   itojun 		close(dummy);
    633  1.1   itojun 	}
    634  1.1   itojun 
    635  1.1   itojun #if defined(SO_SNDBUF) && defined(SO_RCVBUF)
    636  1.1   itojun 	if (sockbufsize) {
    637  1.1   itojun 		if (datalen > sockbufsize)
    638  1.1   itojun 			warnx("you need -b to increae socket buffer size");
    639  1.1   itojun 		if (setsockopt(s, SOL_SOCKET, SO_SNDBUF, &sockbufsize,
    640  1.1   itojun 			       sizeof(sockbufsize)) < 0)
    641  1.1   itojun 			err(1, "setsockopt(SO_SNDBUF)");
    642  1.1   itojun 		if (setsockopt(s, SOL_SOCKET, SO_RCVBUF, &sockbufsize,
    643  1.1   itojun 			       sizeof(sockbufsize)) < 0)
    644  1.1   itojun 			err(1, "setsockopt(SO_RCVBUF)");
    645  1.1   itojun 	}
    646  1.1   itojun 	else {
    647  1.1   itojun 		if (datalen > 8 * 1024)	/*XXX*/
    648  1.1   itojun 			warnx("you need -b to increase socket buffer size");
    649  1.1   itojun 		/*
    650  1.1   itojun 		 * When pinging the broadcast address, you can get a lot of
    651  1.1   itojun 		 * answers. Doing something so evil is useful if you are trying
    652  1.1   itojun 		 * to stress the ethernet, or just want to fill the arp cache
    653  1.1   itojun 		 * to get some stuff for /etc/ethers.
    654  1.1   itojun 		 */
    655  1.1   itojun 		hold = 48 * 1024;
    656  1.1   itojun 		setsockopt(s, SOL_SOCKET, SO_RCVBUF, (char *)&hold, sizeof(hold));
    657  1.1   itojun 	}
    658  1.1   itojun #endif
    659  1.1   itojun 
    660  1.1   itojun 	optval = 1;
    661  1.1   itojun #ifndef SIN6_IFINDEX
    662  1.1   itojun 	setsockopt(s, IPPROTO_IPV6, IPV6_PKTINFO, &optval, sizeof(optval));
    663  1.1   itojun #endif
    664  1.1   itojun 	setsockopt(s, IPPROTO_IPV6, IPV6_HOPLIMIT, &optval, sizeof(optval));
    665  1.1   itojun 
    666  1.1   itojun 	printf("PING6(%d=40+8+%d bytes) ", datalen + 48, datalen);
    667  1.1   itojun 	printf("%s --> ", inet_ntop(AF_INET6, &src.sin6_addr, ntop_buf, sizeof(ntop_buf)));
    668  1.1   itojun 	printf("%s\n", inet_ntop(AF_INET6, &dst.sin6_addr, ntop_buf, sizeof(ntop_buf)));
    669  1.1   itojun 
    670  1.1   itojun 	while (preload--)		/* Fire off them quickies. */
    671  1.1   itojun 		pinger();
    672  1.1   itojun 
    673  1.1   itojun 	(void)signal(SIGINT, onint);
    674  1.1   itojun 	(void)signal(SIGINFO, oninfo);
    675  1.1   itojun 
    676  1.1   itojun 	if ((options & F_FLOOD) == 0) {
    677  1.1   itojun 		(void)signal(SIGALRM, onalrm);
    678  1.1   itojun 		itimer.it_interval.tv_sec = interval;
    679  1.1   itojun 		itimer.it_interval.tv_usec = 0;
    680  1.1   itojun 		itimer.it_value.tv_sec = 0;
    681  1.1   itojun 		itimer.it_value.tv_usec = 1;
    682  1.1   itojun 		(void)setitimer(ITIMER_REAL, &itimer, NULL);
    683  1.1   itojun 	}
    684  1.1   itojun 
    685  1.1   itojun 	FD_ZERO(&fdset);
    686  1.1   itojun 	timeout.tv_sec = 0;
    687  1.1   itojun 	timeout.tv_usec = 10000;
    688  1.1   itojun 	for (;;) {
    689  1.1   itojun 		struct msghdr m;
    690  1.1   itojun 		struct cmsghdr *cm;
    691  1.1   itojun 		u_char buf[256];
    692  1.1   itojun 		struct iovec iov[2];
    693  1.1   itojun 
    694  1.1   itojun 		if (options & F_FLOOD) {
    695  1.1   itojun 			pinger();
    696  1.1   itojun 			FD_SET(s, &fdset);
    697  1.1   itojun 			if (select(s + 1, &fdset, NULL, NULL, &timeout) < 1)
    698  1.1   itojun 				continue;
    699  1.1   itojun 		}
    700  1.1   itojun 		fromlen = sizeof(from);
    701  1.1   itojun 
    702  1.1   itojun 		m.msg_name = (caddr_t)&from;
    703  1.1   itojun 		m.msg_namelen = sizeof(from);
    704  1.1   itojun 		memset(&iov, 0, sizeof(iov));
    705  1.1   itojun 		iov[0].iov_base = (caddr_t)packet;
    706  1.1   itojun 		iov[0].iov_len = packlen;
    707  1.1   itojun 		m.msg_iov = iov;
    708  1.1   itojun 		m.msg_iovlen = 1;
    709  1.1   itojun 		cm = (struct cmsghdr *)buf;
    710  1.1   itojun 		m.msg_control = (caddr_t)buf;
    711  1.1   itojun 		m.msg_controllen = sizeof(buf);
    712  1.1   itojun 
    713  1.1   itojun 		if ((cc = recvmsg(s, &m, 0)) < 0) {
    714  1.1   itojun 			if (errno == EINTR)
    715  1.1   itojun 				continue;
    716  1.1   itojun 			warn("recvfrom");
    717  1.1   itojun 			continue;
    718  1.1   itojun 		}
    719  1.1   itojun 
    720  1.1   itojun 		pr_pack(packet, cc, &m);
    721  1.1   itojun 		if (npackets && nreceived >= npackets)
    722  1.1   itojun 			break;
    723  1.1   itojun 	}
    724  1.1   itojun 	summary();
    725  1.1   itojun 	exit(nreceived == 0);
    726  1.1   itojun }
    727  1.1   itojun 
    728  1.1   itojun /*
    729  1.1   itojun  * onalrm --
    730  1.1   itojun  *	This routine transmits another ping6.
    731  1.1   itojun  */
    732  1.1   itojun void
    733  1.1   itojun onalrm(signo)
    734  1.1   itojun 	int signo;
    735  1.1   itojun {
    736  1.1   itojun 	struct itimerval itimer;
    737  1.1   itojun 
    738  1.1   itojun 	if (!npackets || ntransmitted < npackets) {
    739  1.1   itojun 		pinger();
    740  1.1   itojun 		return;
    741  1.1   itojun 	}
    742  1.1   itojun 
    743  1.1   itojun 	/*
    744  1.1   itojun 	 * If we're not transmitting any more packets, change the timer
    745  1.1   itojun 	 * to wait two round-trip times if we've received any packets or
    746  1.1   itojun 	 * ten seconds if we haven't.
    747  1.1   itojun 	 */
    748  1.1   itojun #define	MAXWAIT		10
    749  1.1   itojun 	if (nreceived) {
    750  1.1   itojun 		itimer.it_value.tv_sec =  2 * tmax / 1000;
    751  1.1   itojun 		if (itimer.it_value.tv_sec == 0)
    752  1.1   itojun 			itimer.it_value.tv_sec = 1;
    753  1.1   itojun 	} else
    754  1.1   itojun 		itimer.it_value.tv_sec = MAXWAIT;
    755  1.1   itojun 	itimer.it_interval.tv_sec = 0;
    756  1.1   itojun 	itimer.it_interval.tv_usec = 0;
    757  1.1   itojun 	itimer.it_value.tv_usec = 0;
    758  1.1   itojun 
    759  1.1   itojun 	(void)signal(SIGALRM, onint);
    760  1.1   itojun 	(void)setitimer(ITIMER_REAL, &itimer, NULL);
    761  1.1   itojun }
    762  1.1   itojun 
    763  1.1   itojun /*
    764  1.1   itojun  * pinger --
    765  1.1   itojun  *	Compose and transmit an ICMP ECHO REQUEST packet.  The IP packet
    766  1.1   itojun  * will be added on by the kernel.  The ID field is our UNIX process ID,
    767  1.1   itojun  * and the sequence number is an ascending integer.  The first 8 bytes
    768  1.1   itojun  * of the data portion are used to hold a UNIX "timeval" struct in VAX
    769  1.1   itojun  * byte-order, to compute the round-trip time.
    770  1.1   itojun  */
    771  1.1   itojun void
    772  1.1   itojun pinger()
    773  1.1   itojun {
    774  1.1   itojun 	struct icmp6_hdr *icp;
    775  1.1   itojun 	struct iovec iov[2];
    776  1.1   itojun 	int i, cc;
    777  1.1   itojun 
    778  1.1   itojun 	icp = (struct icmp6_hdr *)outpack;
    779  1.1   itojun 	icp->icmp6_code = 0;
    780  1.1   itojun 	icp->icmp6_cksum = 0;
    781  1.1   itojun 	icp->icmp6_seq = ntransmitted++;
    782  1.1   itojun 	icp->icmp6_id = ident;			/* ID */
    783  1.1   itojun 
    784  1.1   itojun 	CLR(icp->icmp6_seq % mx_dup_ck);
    785  1.1   itojun 
    786  1.1   itojun 	if (options & F_FQDN) {
    787  1.1   itojun 		icp->icmp6_type = ICMP6_NI_QUERY;
    788  1.1   itojun 		/* code field is always 0 */
    789  1.1   itojun 		/* XXX: overwrite icmp6_id */
    790  1.1   itojun 		icp->icmp6_data16[0] = htons(NI_QTYPE_FQDN);
    791  1.1   itojun 		if (timing)
    792  1.1   itojun 			(void)gettimeofday((struct timeval *)
    793  1.1   itojun 					   &outpack[ICMP6ECHOLEN], NULL);
    794  1.1   itojun 		cc = ICMP6_NIQLEN;
    795  1.1   itojun 		datalen = 0;
    796  1.1   itojun 	} else if (options & F_NODEADDR) {
    797  1.1   itojun 		icp->icmp6_type = ICMP6_NI_QUERY;
    798  1.1   itojun 		/* code field is always 0 */
    799  1.1   itojun 		/* XXX: overwrite icmp6_id */
    800  1.1   itojun 		icp->icmp6_data16[0] = htons(NI_QTYPE_NODEADDR);
    801  1.1   itojun 		if (timing)
    802  1.1   itojun 			(void)gettimeofday((struct timeval *)
    803  1.1   itojun 					   &outpack[ICMP6ECHOLEN], NULL);
    804  1.1   itojun 		cc = ICMP6_NIQLEN;
    805  1.1   itojun 		datalen = 0;
    806  1.1   itojun 		((struct icmp6_nodeinfo *)icp)->ni_flags = naflags;
    807  1.1   itojun 	}
    808  1.1   itojun 	else {
    809  1.1   itojun 		icp->icmp6_type = ICMP6_ECHO_REQUEST;
    810  1.1   itojun 		if (timing)
    811  1.1   itojun 			(void)gettimeofday((struct timeval *)
    812  1.1   itojun 					   &outpack[ICMP6ECHOLEN], NULL);
    813  1.1   itojun 		cc = ICMP6ECHOLEN + datalen;
    814  1.1   itojun 	}
    815  1.1   itojun 
    816  1.1   itojun 	smsghdr.msg_name = (caddr_t)&dst;
    817  1.1   itojun 	smsghdr.msg_namelen = sizeof(dst);
    818  1.1   itojun 	memset(&iov, 0, sizeof(iov));
    819  1.1   itojun 	iov[0].iov_base = (caddr_t)outpack;
    820  1.1   itojun 	iov[0].iov_len = cc;
    821  1.1   itojun 	smsghdr.msg_iov = iov;
    822  1.1   itojun 	smsghdr.msg_iovlen = 1;
    823  1.1   itojun 
    824  1.1   itojun 	i = sendmsg(s, &smsghdr, 0);
    825  1.1   itojun 
    826  1.1   itojun 	if (i < 0 || i != cc)  {
    827  1.1   itojun 		if (i < 0)
    828  1.1   itojun 			warn("sendmsg");
    829  1.1   itojun 		(void)printf("ping6: wrote %s %d chars, ret=%d\n",
    830  1.1   itojun 		    hostname, cc, i);
    831  1.1   itojun 	}
    832  1.1   itojun 	if (!(options & F_QUIET) && options & F_FLOOD)
    833  1.1   itojun 		(void)write(STDOUT_FILENO, &DOT, 1);
    834  1.1   itojun }
    835  1.1   itojun 
    836  1.1   itojun /*
    837  1.1   itojun  * pr_pack --
    838  1.1   itojun  *	Print out the packet, if it came from us.  This logic is necessary
    839  1.1   itojun  * because ALL readers of the ICMP socket get a copy of ALL ICMP packets
    840  1.1   itojun  * which arrive ('tis only fair).  This permits multiple copies of this
    841  1.1   itojun  * program to be run without having intermingled output (or statistics!).
    842  1.1   itojun  */
    843  1.1   itojun void
    844  1.1   itojun pr_pack(buf, cc, mhdr)
    845  1.1   itojun 	u_char *buf;
    846  1.1   itojun 	int cc;
    847  1.1   itojun 	struct msghdr *mhdr;
    848  1.1   itojun {
    849  1.1   itojun 	struct icmp6_hdr *icp;
    850  1.1   itojun 	int i;
    851  1.1   itojun 	int hoplim;
    852  1.1   itojun 	struct sockaddr_in6 *from = (struct sockaddr_in6 *)mhdr->msg_name;
    853  1.1   itojun 	u_char *cp = NULL, *dp, *end = buf + cc;
    854  1.1   itojun #ifdef OLD_RAWSOCKET
    855  1.1   itojun 	struct ip6_hdr *ip;
    856  1.1   itojun #endif
    857  1.1   itojun 	struct timeval tv, *tp;
    858  1.1   itojun 	double triptime = 0;
    859  1.1   itojun 	int dupflag;
    860  1.1   itojun 	size_t off;
    861  1.1   itojun 
    862  1.1   itojun 	(void)gettimeofday(&tv, NULL);
    863  1.1   itojun 
    864  1.1   itojun #ifdef OLD_RAWSOCKET
    865  1.1   itojun 	/* Check the IP header */
    866  1.1   itojun 	ip = (struct ip6_hdr *)buf;
    867  1.1   itojun 	if (cc < sizeof(struct icmp6_hdr) + sizeof(struct ip6_hdr)) {
    868  1.1   itojun 		if (options & F_VERBOSE)
    869  1.1   itojun 			warnx("packet too short (%d bytes) from %s\n", cc,
    870  1.1   itojun 			  inet_ntop(AF_INET6, (void *)&from->sin6_addr,
    871  1.1   itojun 				    ntop_buf, sizeof(ntop_buf)));
    872  1.1   itojun 		return;
    873  1.1   itojun 	}
    874  1.1   itojun 
    875  1.1   itojun 	/* chase nexthdr link */
    876  1.1   itojun     {
    877  1.1   itojun 	u_int8_t nh;
    878  1.1   itojun 	struct ah *ah;
    879  1.1   itojun 	struct ip6_ext *ip6e;
    880  1.1   itojun 
    881  1.1   itojun 	off = IP6LEN;
    882  1.1   itojun 	nh = ip->ip6_nxt;
    883  1.1   itojun 	while (nh != IPPROTO_ICMPV6) {
    884  1.1   itojun 		if (options & F_VERBOSE)
    885  1.1   itojun 			fprintf(stderr, "header chain: type=0x%x\n", nh);
    886  1.1   itojun 
    887  1.1   itojun 		switch (nh) {
    888  1.1   itojun 		case IPPROTO_AH:
    889  1.1   itojun 			ah = (struct ah *)(buf + off);
    890  1.1   itojun 			off += sizeof(struct ah);
    891  1.1   itojun 			off += (ah->ah_len << 2);
    892  1.1   itojun 			nh = ah->ah_nxt;
    893  1.1   itojun 			break;
    894  1.1   itojun 
    895  1.1   itojun 		 case IPPROTO_HOPOPTS:
    896  1.1   itojun 			ip6e = (struct ip6_ext *)(buf + off);
    897  1.1   itojun 			off += (ip6e->ip6e_len + 1) << 3;
    898  1.1   itojun 			nh = ip6e->ip6e_nxt;
    899  1.1   itojun 			break;
    900  1.1   itojun 		default:
    901  1.1   itojun 			if (options & F_VERBOSE) {
    902  1.1   itojun 				fprintf(stderr,
    903  1.1   itojun 					"unknown header type=0x%x: drop it\n",
    904  1.1   itojun 					nh);
    905  1.1   itojun 			}
    906  1.1   itojun 			return;
    907  1.1   itojun 		}
    908  1.1   itojun 	}
    909  1.1   itojun     }
    910  1.1   itojun 	/* Now the ICMP part */
    911  1.1   itojun 	icp = (struct icmp6_hdr *)(buf + off);
    912  1.1   itojun #else
    913  1.1   itojun 	if (cc < sizeof(struct icmp6_hdr)) {
    914  1.1   itojun 		if (options & F_VERBOSE)
    915  1.1   itojun 			warnx("packet too short (%d bytes) from %s\n", cc,
    916  1.1   itojun 			  inet_ntop(AF_INET6, (void *)&from->sin6_addr,
    917  1.1   itojun 				    ntop_buf, sizeof(ntop_buf)));
    918  1.1   itojun 		return;
    919  1.1   itojun 	}
    920  1.1   itojun 	icp = (struct icmp6_hdr *)buf;
    921  1.1   itojun 	off = 0;
    922  1.1   itojun #endif
    923  1.1   itojun 
    924  1.1   itojun 	if ((hoplim = get_hoplim(mhdr)) == -1) {
    925  1.1   itojun 		warnx("failed to get receiving hop limit");
    926  1.1   itojun 		return;
    927  1.1   itojun 	}
    928  1.1   itojun 
    929  1.1   itojun 	if (icp->icmp6_type == ICMP6_ECHO_REPLY) {
    930  1.1   itojun 		if (icp->icmp6_id != ident)
    931  1.1   itojun 			return;			/* It was not our ECHO */
    932  1.1   itojun 		++nreceived;
    933  1.1   itojun 		if (timing) {
    934  1.1   itojun 			tp = (struct timeval *)(icp + 1);
    935  1.1   itojun 			tvsub(&tv, tp);
    936  1.1   itojun 			triptime = ((double)tv.tv_sec) * 1000.0 +
    937  1.1   itojun 			    ((double)tv.tv_usec) / 1000.0;
    938  1.1   itojun 			tsum += triptime;
    939  1.1   itojun 			if (triptime < tmin)
    940  1.1   itojun 				tmin = triptime;
    941  1.1   itojun 			if (triptime > tmax)
    942  1.1   itojun 				tmax = triptime;
    943  1.1   itojun 		}
    944  1.1   itojun 
    945  1.1   itojun 		if (TST(icp->icmp6_seq % mx_dup_ck)) {
    946  1.1   itojun 			++nrepeats;
    947  1.1   itojun 			--nreceived;
    948  1.1   itojun 			dupflag = 1;
    949  1.1   itojun 		} else {
    950  1.1   itojun 			SET(icp->icmp6_seq % mx_dup_ck);
    951  1.1   itojun 			dupflag = 0;
    952  1.1   itojun 		}
    953  1.1   itojun 
    954  1.1   itojun 		if (options & F_QUIET)
    955  1.1   itojun 			return;
    956  1.1   itojun 
    957  1.1   itojun 		if (options & F_FLOOD)
    958  1.1   itojun 			(void)write(STDOUT_FILENO, &BSPACE, 1);
    959  1.1   itojun 		else {
    960  1.1   itojun 			(void)printf("%d bytes from %s, icmp_seq=%u", cc,
    961  1.1   itojun 				     pr_addr(&from->sin6_addr),
    962  1.1   itojun 				     icp->icmp6_seq);
    963  1.1   itojun 			(void)printf(" hlim=%d", hoplim);
    964  1.1   itojun 			if (timing)
    965  1.1   itojun 				(void)printf(" time=%g ms", triptime);
    966  1.1   itojun 			if (dupflag)
    967  1.1   itojun 				(void)printf("(DUP!)");
    968  1.1   itojun 			/* check the data */
    969  1.1   itojun 			cp = buf + off + ICMP6ECHOLEN + ICMP6ECHOTMLEN;
    970  1.1   itojun 			dp = outpack + ICMP6ECHOLEN + ICMP6ECHOTMLEN;
    971  1.1   itojun 			for (i = 8; cp < end; ++i, ++cp, ++dp) {
    972  1.1   itojun 				if (*cp != *dp) {
    973  1.1   itojun 					(void)printf("\nwrong data byte #%d should be 0x%x but was 0x%x", i, *dp, *cp);
    974  1.1   itojun 					break;
    975  1.1   itojun 				}
    976  1.1   itojun 			}
    977  1.1   itojun 		}
    978  1.1   itojun 	} else if (icp->icmp6_type == ICMP6_NI_REPLY) { /* ICMP6_NI_REPLY */
    979  1.1   itojun 		struct icmp6_nodeinfo *ni = (struct icmp6_nodeinfo *)(buf + off);
    980  1.1   itojun 
    981  1.1   itojun 		(void)printf("%d bytes from %s: ", cc,
    982  1.1   itojun 			     pr_addr(&from->sin6_addr));
    983  1.1   itojun 
    984  1.1   itojun 		switch(ntohs(ni->ni_qtype)) {
    985  1.1   itojun 		 case NI_QTYPE_NOOP:
    986  1.1   itojun 			 printf("NodeInfo NOOP");
    987  1.1   itojun 			 break;
    988  1.1   itojun 		 case NI_QTYPE_SUPTYPES:
    989  1.1   itojun 			 printf("NodeInfo Supported Qtypes");
    990  1.1   itojun 			 break;
    991  1.1   itojun 		 case NI_QTYPE_NODEADDR:
    992  1.1   itojun 			 pr_nodeaddr(ni, end - (u_char *)ni);
    993  1.1   itojun 			 break;
    994  1.1   itojun 		 case NI_QTYPE_FQDN:
    995  1.1   itojun 		 default:	/* XXX: for backward compatibility */
    996  1.1   itojun 			 cp = (u_char *)ni + ICMP6_NIRLEN + 1;
    997  1.1   itojun 			 while (cp < end) {
    998  1.1   itojun 				 if (isprint(*cp))
    999  1.1   itojun 					 putchar(*cp);
   1000  1.1   itojun 				 else
   1001  1.1   itojun 					 printf("\\%03o", *cp & 0xff);
   1002  1.1   itojun 				 cp++;
   1003  1.1   itojun 			 }
   1004  1.1   itojun 			 if (options & F_VERBOSE) {
   1005  1.1   itojun 				 long ttl;
   1006  1.1   itojun 
   1007  1.1   itojun 				 (void)printf(" (");
   1008  1.1   itojun 
   1009  1.1   itojun 				 switch(ni->ni_code) {
   1010  1.1   itojun 				  case ICMP6_NI_REFUSED:
   1011  1.1   itojun 					  (void)printf("refused,");
   1012  1.1   itojun 					  break;
   1013  1.1   itojun 				  case ICMP6_NI_UNKNOWN:
   1014  1.1   itojun 					  (void)printf("unknwon qtype,");
   1015  1.1   itojun 					  break;
   1016  1.1   itojun 				 }
   1017  1.1   itojun 
   1018  1.1   itojun 				 if ((end - (u_char *)ni) < ICMP6_NIRLEN) {
   1019  1.1   itojun 					 /* case of refusion, unkown */
   1020  1.1   itojun 					 goto fqdnend;
   1021  1.1   itojun 				 }
   1022  1.1   itojun 				 ttl = ntohl(*(u_long *)&buf[off+ICMP6ECHOLEN+8]);
   1023  1.1   itojun 				 if (!(ni->ni_flags & NI_FQDN_FLAG_VALIDTTL))
   1024  1.1   itojun 					 (void)printf("TTL=%d:meaningless",
   1025  1.1   itojun 						      (int)ttl);
   1026  1.1   itojun 				 else {
   1027  1.1   itojun 					 if (ttl < 0)
   1028  1.1   itojun 						 (void)printf("TTL=%d:invalid",
   1029  1.1   itojun 							      (int)ttl);
   1030  1.1   itojun 					 else
   1031  1.1   itojun 						 (void)printf("TTL=%d",
   1032  1.1   itojun 							      (int)ttl);
   1033  1.1   itojun 				 }
   1034  1.1   itojun 
   1035  1.1   itojun 				 if (buf[off + ICMP6_NIRLEN] !=
   1036  1.1   itojun 				     cc - off - ICMP6_NIRLEN - 1) {
   1037  1.2  thorpej 					 (void)printf(",invalid namelen:%d/%lu",
   1038  1.1   itojun 						      buf[off + ICMP6_NIRLEN],
   1039  1.2  thorpej 						      (u_long)cc - off - ICMP6_NIRLEN - 1);
   1040  1.1   itojun 				 }
   1041  1.1   itojun 				 putchar(')');
   1042  1.1   itojun 			 }
   1043  1.1   itojun 		  fqdnend:
   1044  1.1   itojun 			 ;
   1045  1.1   itojun 		}
   1046  1.1   itojun 	} else {
   1047  1.1   itojun 		/* We've got something other than an ECHOREPLY */
   1048  1.1   itojun 		if (!(options & F_VERBOSE))
   1049  1.1   itojun 			return;
   1050  1.1   itojun 		(void)printf("%d bytes from %s: ", cc,
   1051  1.1   itojun 			     pr_addr(&from->sin6_addr));
   1052  1.1   itojun 		pr_icmph(icp, end);
   1053  1.1   itojun 	}
   1054  1.1   itojun 
   1055  1.1   itojun 	if (!(options & F_FLOOD)) {
   1056  1.1   itojun 		(void)putchar('\n');
   1057  1.1   itojun 		(void)fflush(stdout);
   1058  1.1   itojun 	}
   1059  1.1   itojun }
   1060  1.1   itojun 
   1061  1.1   itojun void
   1062  1.1   itojun pr_nodeaddr(ni, nilen)
   1063  1.1   itojun 	struct icmp6_nodeinfo *ni; /* ni->qtype must be NODEADDR */
   1064  1.1   itojun 	int nilen;
   1065  1.1   itojun {
   1066  1.1   itojun 	struct in6_addr *ia6 = (struct in6_addr *)(ni + 1);
   1067  1.1   itojun 
   1068  1.1   itojun 	nilen -= sizeof(struct icmp6_nodeinfo);
   1069  1.1   itojun 
   1070  1.1   itojun 	if (options & F_VERBOSE) {
   1071  1.1   itojun 		switch(ni->ni_code) {
   1072  1.1   itojun 		 case ICMP6_NI_REFUSED:
   1073  1.1   itojun 			 (void)printf("refused");
   1074  1.1   itojun 			 break;
   1075  1.1   itojun 		 case ICMP6_NI_UNKNOWN:
   1076  1.1   itojun 			 (void)printf("unknown qtype");
   1077  1.1   itojun 			 break;
   1078  1.1   itojun 		}
   1079  1.1   itojun 		if (ni->ni_flags & NI_NODEADDR_FLAG_ALL)
   1080  1.1   itojun 			(void)printf(" truncated");
   1081  1.1   itojun 	}
   1082  1.1   itojun 	putchar('\n');
   1083  1.1   itojun 	if (nilen <= 0)
   1084  1.1   itojun 		printf("  no address\n");
   1085  1.1   itojun 	for (; nilen > 0; nilen -= sizeof(*ia6), ia6 += 1) {
   1086  1.1   itojun 		printf("  %s\n",
   1087  1.1   itojun 		       inet_ntop(AF_INET6, ia6, ntop_buf, sizeof(ntop_buf)));
   1088  1.1   itojun 	}
   1089  1.1   itojun }
   1090  1.1   itojun 
   1091  1.1   itojun int
   1092  1.1   itojun get_hoplim(mhdr)
   1093  1.1   itojun 	struct msghdr *mhdr;
   1094  1.1   itojun {
   1095  1.1   itojun 	struct cmsghdr *cm;
   1096  1.1   itojun 
   1097  1.1   itojun 	for (cm = (struct cmsghdr *)CMSG_FIRSTHDR(mhdr); cm;
   1098  1.1   itojun 	     cm = (struct cmsghdr *)CMSG_NXTHDR(mhdr, cm)) {
   1099  1.1   itojun 		if (cm->cmsg_level == IPPROTO_IPV6 &&
   1100  1.1   itojun 		    cm->cmsg_type == IPV6_HOPLIMIT &&
   1101  1.1   itojun 		    cm->cmsg_len == CMSG_LEN(sizeof(int)))
   1102  1.1   itojun 			return(*(int *)CMSG_DATA(cm));
   1103  1.1   itojun 	}
   1104  1.1   itojun 
   1105  1.1   itojun 	return(-1);
   1106  1.1   itojun }
   1107  1.1   itojun 
   1108  1.1   itojun /*
   1109  1.1   itojun  * tvsub --
   1110  1.1   itojun  *	Subtract 2 timeval structs:  out = out - in.  Out is assumed to
   1111  1.1   itojun  * be >= in.
   1112  1.1   itojun  */
   1113  1.1   itojun void
   1114  1.1   itojun tvsub(out, in)
   1115  1.1   itojun 	register struct timeval *out, *in;
   1116  1.1   itojun {
   1117  1.1   itojun 	if ((out->tv_usec -= in->tv_usec) < 0) {
   1118  1.1   itojun 		--out->tv_sec;
   1119  1.1   itojun 		out->tv_usec += 1000000;
   1120  1.1   itojun 	}
   1121  1.1   itojun 	out->tv_sec -= in->tv_sec;
   1122  1.1   itojun }
   1123  1.1   itojun 
   1124  1.1   itojun /*
   1125  1.1   itojun  * oninfo --
   1126  1.1   itojun  *	SIGINFO handler.
   1127  1.1   itojun  */
   1128  1.1   itojun void
   1129  1.1   itojun oninfo(notused)
   1130  1.1   itojun 	int notused;
   1131  1.1   itojun {
   1132  1.1   itojun 	summary();
   1133  1.1   itojun }
   1134  1.1   itojun 
   1135  1.1   itojun /*
   1136  1.1   itojun  * onint --
   1137  1.1   itojun  *	SIGINT handler.
   1138  1.1   itojun  */
   1139  1.1   itojun void
   1140  1.1   itojun onint(notused)
   1141  1.1   itojun 	int notused;
   1142  1.1   itojun {
   1143  1.1   itojun 	summary();
   1144  1.1   itojun 
   1145  1.1   itojun 	(void)signal(SIGINT, SIG_DFL);
   1146  1.1   itojun 	(void)kill(getpid(), SIGINT);
   1147  1.1   itojun 
   1148  1.1   itojun 	/* NOTREACHED */
   1149  1.1   itojun 	exit(1);
   1150  1.1   itojun }
   1151  1.1   itojun 
   1152  1.1   itojun /*
   1153  1.1   itojun  * summary --
   1154  1.1   itojun  *	Print out statistics.
   1155  1.1   itojun  */
   1156  1.1   itojun void
   1157  1.1   itojun summary()
   1158  1.1   itojun {
   1159  1.1   itojun 	register int i;
   1160  1.1   itojun 
   1161  1.1   itojun 	(void)printf("\n--- %s ping6 statistics ---\n", hostname);
   1162  1.1   itojun 	(void)printf("%ld packets transmitted, ", ntransmitted);
   1163  1.1   itojun 	(void)printf("%ld packets received, ", nreceived);
   1164  1.1   itojun 	if (nrepeats)
   1165  1.1   itojun 		(void)printf("+%ld duplicates, ", nrepeats);
   1166  1.1   itojun 	if (ntransmitted) {
   1167  1.1   itojun 		if (nreceived > ntransmitted)
   1168  1.1   itojun 			(void)printf("-- somebody's printing up packets!");
   1169  1.1   itojun 		else
   1170  1.1   itojun 			(void)printf("%d%% packet loss",
   1171  1.1   itojun 			    (int) (((ntransmitted - nreceived) * 100) /
   1172  1.1   itojun 			    ntransmitted));
   1173  1.1   itojun 	}
   1174  1.1   itojun 	(void)putchar('\n');
   1175  1.1   itojun 	if (nreceived && timing) {
   1176  1.1   itojun 		/* Only display average to microseconds */
   1177  1.1   itojun 		i = 1000.0 * tsum / (nreceived + nrepeats);
   1178  1.1   itojun 		(void)printf("round-trip min/avg/max = %g/%g/%g ms\n",
   1179  1.1   itojun 		    tmin, ((double)i) / 1000.0, tmax);
   1180  1.1   itojun 		(void)fflush(stdout);
   1181  1.1   itojun 	}
   1182  1.1   itojun }
   1183  1.1   itojun 
   1184  1.1   itojun #ifdef notdef
   1185  1.1   itojun static char *ttab[] = {
   1186  1.1   itojun 	"Echo Reply",		/* ip + seq + udata */
   1187  1.1   itojun 	"Dest Unreachable",	/* net, host, proto, port, frag, sr + IP */
   1188  1.1   itojun 	"Source Quench",	/* IP */
   1189  1.1   itojun 	"Redirect",		/* redirect type, gateway, + IP  */
   1190  1.1   itojun 	"Echo",
   1191  1.1   itojun 	"Time Exceeded",	/* transit, frag reassem + IP */
   1192  1.1   itojun 	"Parameter Problem",	/* pointer + IP */
   1193  1.1   itojun 	"Timestamp",		/* id + seq + three timestamps */
   1194  1.1   itojun 	"Timestamp Reply",	/* " */
   1195  1.1   itojun 	"Info Request",		/* id + sq */
   1196  1.1   itojun 	"Info Reply"		/* " */
   1197  1.1   itojun };
   1198  1.1   itojun #endif
   1199  1.1   itojun 
   1200  1.1   itojun /*
   1201  1.1   itojun  * pr_icmph --
   1202  1.1   itojun  *	Print a descriptive string about an ICMP header.
   1203  1.1   itojun  */
   1204  1.1   itojun void
   1205  1.1   itojun pr_icmph(icp, end)
   1206  1.1   itojun 	struct icmp6_hdr *icp;
   1207  1.1   itojun 	u_char *end;
   1208  1.1   itojun {
   1209  1.1   itojun 	switch(icp->icmp6_type) {
   1210  1.1   itojun 	case ICMP6_DST_UNREACH:
   1211  1.1   itojun 		switch(icp->icmp6_code) {
   1212  1.1   itojun 		case ICMP6_DST_UNREACH_NOROUTE:
   1213  1.1   itojun 			(void)printf("No Route to Destination\n");
   1214  1.1   itojun 			break;
   1215  1.1   itojun 		case ICMP6_DST_UNREACH_ADMIN:
   1216  1.1   itojun 			(void)printf("Destination Administratively "
   1217  1.1   itojun 				     "Unreachable\n");
   1218  1.1   itojun 			break;
   1219  1.1   itojun 		case ICMP6_DST_UNREACH_NOTNEIGHBOR:
   1220  1.1   itojun 			(void)printf("Destination Unreachable Notneighbor\n");
   1221  1.1   itojun 			break;
   1222  1.1   itojun 		case ICMP6_DST_UNREACH_ADDR:
   1223  1.1   itojun 			(void)printf("Destination Host Unreachable\n");
   1224  1.1   itojun 			break;
   1225  1.1   itojun 		case ICMP6_DST_UNREACH_NOPORT:
   1226  1.1   itojun 			(void)printf("Destination Port Unreachable\n");
   1227  1.1   itojun 			break;
   1228  1.1   itojun 		default:
   1229  1.1   itojun 			(void)printf("Destination Unreachable, Bad Code: %d\n",
   1230  1.1   itojun 			    icp->icmp6_code);
   1231  1.1   itojun 			break;
   1232  1.1   itojun 		}
   1233  1.1   itojun 		/* Print returned IP header information */
   1234  1.1   itojun 		pr_retip((struct ip6_hdr *)(icp + 1), end);
   1235  1.1   itojun 		break;
   1236  1.1   itojun 	case ICMP6_PACKET_TOO_BIG:
   1237  1.1   itojun 		(void)printf("Packet too big mtu = %d\n",
   1238  1.1   itojun 			     (int)ntohl(icp->icmp6_mtu));
   1239  1.1   itojun 		break;
   1240  1.1   itojun 	case ICMP6_TIME_EXCEEDED:
   1241  1.1   itojun 		switch(icp->icmp6_code) {
   1242  1.1   itojun 		case ICMP6_TIME_EXCEED_TRANSIT:
   1243  1.1   itojun 			(void)printf("Time to live exceeded\n");
   1244  1.1   itojun 			break;
   1245  1.1   itojun 		case ICMP6_TIME_EXCEED_REASSEMBLY:
   1246  1.1   itojun 			(void)printf("Frag reassembly time exceeded\n");
   1247  1.1   itojun 			break;
   1248  1.1   itojun 		default:
   1249  1.1   itojun 			(void)printf("Time exceeded, Bad Code: %d\n",
   1250  1.1   itojun 			    icp->icmp6_code);
   1251  1.1   itojun 			break;
   1252  1.1   itojun 		}
   1253  1.1   itojun 		pr_retip((struct ip6_hdr *)(icp + 1), end);
   1254  1.1   itojun 		break;
   1255  1.1   itojun 	case ICMP6_PARAM_PROB:
   1256  1.1   itojun 		(void)printf("Parameter problem: ");
   1257  1.1   itojun 		switch(icp->icmp6_code) {
   1258  1.1   itojun 		 case ICMP6_PARAMPROB_HEADER:
   1259  1.1   itojun 			 (void)printf("Erroneous Header ");
   1260  1.1   itojun 			 break;
   1261  1.1   itojun 		 case ICMP6_PARAMPROB_NEXTHEADER:
   1262  1.1   itojun 			 (void)printf("Unknown Nextheader ");
   1263  1.1   itojun 			 break;
   1264  1.1   itojun 		 case ICMP6_PARAMPROB_OPTION:
   1265  1.1   itojun 			 (void)printf("Unrecognized Option ");
   1266  1.1   itojun 			 break;
   1267  1.1   itojun 		 default:
   1268  1.1   itojun 			 (void)printf("Bad code(%d) ", icp->icmp6_code);
   1269  1.1   itojun 			 break;
   1270  1.1   itojun 		}
   1271  1.1   itojun 		(void)printf("pointer = 0x%02x\n",
   1272  1.1   itojun 			     (int)ntohl(icp->icmp6_pptr));
   1273  1.1   itojun 		pr_retip((struct ip6_hdr *)(icp + 1), end);
   1274  1.1   itojun 		break;
   1275  1.1   itojun 	case ICMP6_ECHO_REQUEST:
   1276  1.1   itojun 		(void)printf("Echo Request\n");
   1277  1.1   itojun 		/* XXX ID + Seq + Data */
   1278  1.1   itojun 		break;
   1279  1.1   itojun 	case ICMP6_ECHO_REPLY:
   1280  1.1   itojun 		(void)printf("Echo Reply\n");
   1281  1.1   itojun 		/* XXX ID + Seq + Data */
   1282  1.1   itojun 		break;
   1283  1.1   itojun 	case ICMP6_MEMBERSHIP_QUERY:
   1284  1.1   itojun 		(void)printf("Membership Query\n");
   1285  1.1   itojun 		break;
   1286  1.1   itojun 	case ICMP6_MEMBERSHIP_REPORT:
   1287  1.1   itojun 		(void)printf("Membership Report\n");
   1288  1.1   itojun 		break;
   1289  1.1   itojun 	case ICMP6_MEMBERSHIP_REDUCTION:
   1290  1.1   itojun 		(void)printf("Membership Reduction\n");
   1291  1.1   itojun 		break;
   1292  1.1   itojun 	case ND_ROUTER_SOLICIT:
   1293  1.1   itojun 		(void)printf("Router Solicitation\n");
   1294  1.1   itojun 		break;
   1295  1.1   itojun 	case ND_ROUTER_ADVERT:
   1296  1.1   itojun 		(void)printf("Router Advertisement\n");
   1297  1.1   itojun 		break;
   1298  1.1   itojun 	case ND_NEIGHBOR_SOLICIT:
   1299  1.1   itojun 		(void)printf("Neighbor Solicitation\n");
   1300  1.1   itojun 		break;
   1301  1.1   itojun 	case ND_NEIGHBOR_ADVERT:
   1302  1.1   itojun 		(void)printf("Neighbor Advertisement\n");
   1303  1.1   itojun 		break;
   1304  1.1   itojun 	case ND_REDIRECT:
   1305  1.1   itojun 	{
   1306  1.1   itojun 		struct nd_redirect *red = (struct nd_redirect *)icp;
   1307  1.1   itojun 
   1308  1.1   itojun 		(void)printf("Redirect\n");
   1309  1.1   itojun 		(void)printf("Destination: %s\n",
   1310  1.1   itojun 			     inet_ntop(AF_INET6, &red->nd_rd_dst,
   1311  1.1   itojun 				       ntop_buf, sizeof(ntop_buf)));
   1312  1.1   itojun 		(void)printf("New Target: %s\n",
   1313  1.1   itojun 			     inet_ntop(AF_INET6, &red->nd_rd_target,
   1314  1.1   itojun 				       ntop_buf, sizeof(ntop_buf)));
   1315  1.1   itojun 		break;
   1316  1.1   itojun 	}
   1317  1.1   itojun 	case ICMP6_NI_QUERY:
   1318  1.1   itojun 		(void)printf("Node Information Query\n");
   1319  1.1   itojun 		/* XXX ID + Seq + Data */
   1320  1.1   itojun 		break;
   1321  1.1   itojun 	case ICMP6_NI_REPLY:
   1322  1.1   itojun 		(void)printf("Node Information Reply\n");
   1323  1.1   itojun 		/* XXX ID + Seq + Data */
   1324  1.1   itojun 		break;
   1325  1.1   itojun 	default:
   1326  1.1   itojun 		(void)printf("Bad ICMP type: %d\n", icp->icmp6_type);
   1327  1.1   itojun 	}
   1328  1.1   itojun }
   1329  1.1   itojun 
   1330  1.1   itojun /*
   1331  1.1   itojun  * pr_iph --
   1332  1.1   itojun  *	Print an IP6 header.
   1333  1.1   itojun  */
   1334  1.1   itojun void
   1335  1.1   itojun pr_iph(ip6)
   1336  1.1   itojun 	struct ip6_hdr *ip6;
   1337  1.1   itojun {
   1338  1.1   itojun 	u_int32_t flow = ip6->ip6_flow & IPV6_FLOWLABEL_MASK;
   1339  1.1   itojun 	u_int8_t tc;
   1340  1.1   itojun 
   1341  1.1   itojun 	tc = *(&ip6->ip6_vfc + 1); /* XXX */
   1342  1.1   itojun 	tc = (tc >> 4) & 0x0f;
   1343  1.1   itojun 	tc |= (ip6->ip6_vfc << 4);
   1344  1.1   itojun 
   1345  1.1   itojun 	printf("Vr TC  Flow Plen Nxt Hlim\n");
   1346  1.1   itojun 	printf(" %1x %02x %05x %04x  %02x   %02x\n",
   1347  1.1   itojun 	       (ip6->ip6_vfc & IPV6_VERSION_MASK) >> 4, tc, (int)ntohl(flow),
   1348  1.1   itojun 	       ntohs(ip6->ip6_plen),
   1349  1.1   itojun 	       ip6->ip6_nxt, ip6->ip6_hlim);
   1350  1.1   itojun 	printf("%s->", inet_ntop(AF_INET6, &ip6->ip6_src,
   1351  1.1   itojun 				  ntop_buf, INET6_ADDRSTRLEN));
   1352  1.1   itojun 	printf("%s\n", inet_ntop(AF_INET6, &ip6->ip6_dst,
   1353  1.1   itojun 				 ntop_buf, INET6_ADDRSTRLEN));
   1354  1.1   itojun }
   1355  1.1   itojun 
   1356  1.1   itojun /*
   1357  1.1   itojun  * pr_addr --
   1358  1.1   itojun  *	Return an ascii host address as a dotted quad and optionally with
   1359  1.1   itojun  * a hostname.
   1360  1.1   itojun  */
   1361  1.1   itojun char *
   1362  1.1   itojun pr_addr(addr)
   1363  1.1   itojun 	struct in6_addr *addr;
   1364  1.1   itojun {
   1365  1.1   itojun 	static char buf[MAXHOSTNAMELEN];
   1366  1.1   itojun 	struct sockaddr_in6 sin6;
   1367  1.1   itojun 	int flag = 0;
   1368  1.1   itojun 
   1369  1.1   itojun 	if (options & F_NUMERIC)
   1370  1.1   itojun 		flag |= NI_NUMERICHOST;
   1371  1.1   itojun 
   1372  1.1   itojun 	bzero(&sin6, sizeof(sin6));
   1373  1.1   itojun 	sin6.sin6_family = AF_INET6;
   1374  1.1   itojun 	sin6.sin6_len = sizeof(sin6);
   1375  1.1   itojun 	sin6.sin6_addr = *addr;
   1376  1.1   itojun 
   1377  1.1   itojun 	getnameinfo((struct sockaddr *)&sin6, sizeof(sin6),
   1378  1.1   itojun 		    buf, sizeof(buf), NULL, 0, flag);
   1379  1.1   itojun 
   1380  1.1   itojun 	return (buf);
   1381  1.1   itojun }
   1382  1.1   itojun 
   1383  1.1   itojun /*
   1384  1.1   itojun  * pr_retip --
   1385  1.1   itojun  *	Dump some info on a returned (via ICMPv6) IPv6 packet.
   1386  1.1   itojun  */
   1387  1.1   itojun void
   1388  1.1   itojun pr_retip(ip6, end)
   1389  1.1   itojun 	struct ip6_hdr *ip6;
   1390  1.1   itojun 	u_char *end;
   1391  1.1   itojun {
   1392  1.1   itojun 	u_char *cp = (u_char *)ip6, nh;
   1393  1.1   itojun 	int hlen;
   1394  1.1   itojun 
   1395  1.1   itojun 	if (end - (u_char *)ip6 < sizeof(*ip6)) {
   1396  1.1   itojun 		printf("IP6");
   1397  1.1   itojun 		goto trunc;
   1398  1.1   itojun 	}
   1399  1.1   itojun 	pr_iph(ip6);
   1400  1.1   itojun 	hlen = sizeof(*ip6);
   1401  1.1   itojun 
   1402  1.1   itojun 	nh = ip6->ip6_nxt;
   1403  1.1   itojun 	cp += hlen;
   1404  1.1   itojun 	while(end - cp >= 8) {
   1405  1.1   itojun 		switch(nh) {
   1406  1.1   itojun 		 case IPPROTO_HOPOPTS:
   1407  1.1   itojun 			 printf("HBH ");
   1408  1.1   itojun 			 hlen = (((struct ip6_hbh *)cp)->ip6h_len+1) << 3;
   1409  1.1   itojun 			 nh = ((struct ip6_hbh *)cp)->ip6h_nxt;
   1410  1.1   itojun 			 break;
   1411  1.1   itojun 		 case IPPROTO_DSTOPTS:
   1412  1.1   itojun 			 printf("DSTOPT ");
   1413  1.1   itojun 			 hlen = (((struct ip6_dest *)cp)->ip6d_len+1) << 3;
   1414  1.1   itojun 			 nh = ((struct ip6_dest *)cp)->ip6d_nxt;
   1415  1.1   itojun 			 break;
   1416  1.1   itojun 		 case IPPROTO_FRAGMENT:
   1417  1.1   itojun 			 printf("FRAG ");
   1418  1.1   itojun 			 hlen = sizeof(struct ip6_frag);
   1419  1.1   itojun 			 nh = ((struct ip6_frag *)cp)->ip6f_nxt;
   1420  1.1   itojun 			 break;
   1421  1.1   itojun 		 case IPPROTO_ROUTING:
   1422  1.1   itojun 			 printf("RTHDR ");
   1423  1.1   itojun 			 hlen = (((struct ip6_rthdr *)cp)->ip6r_len+1) << 3;
   1424  1.1   itojun 			 nh = ((struct ip6_rthdr *)cp)->ip6r_nxt;
   1425  1.1   itojun 			 break;
   1426  1.1   itojun 		 case IPPROTO_AH:
   1427  1.1   itojun 			 printf("AH ");
   1428  1.1   itojun 			 hlen = (((struct ah *)cp)->ah_len+2) << 2;
   1429  1.1   itojun 			 nh = ((struct ah *)cp)->ah_nxt;
   1430  1.1   itojun 			 break;
   1431  1.1   itojun 		 case IPPROTO_ICMPV6:
   1432  1.1   itojun 			 printf("ICMP6: type = %d, code = %d\n",
   1433  1.1   itojun 				*cp, *(cp + 1));
   1434  1.1   itojun 			 return;
   1435  1.1   itojun 		 case IPPROTO_ESP:
   1436  1.1   itojun 			 printf("ESP\n");
   1437  1.1   itojun 			 return;
   1438  1.1   itojun 		 case IPPROTO_TCP:
   1439  1.1   itojun 			 printf("TCP: from port %u, to port %u (decimal)\n",
   1440  1.1   itojun 				(*cp * 256 + *(cp + 1)),
   1441  1.1   itojun 				(*(cp + 2) * 256 + *(cp + 3)));
   1442  1.1   itojun 			 return;
   1443  1.1   itojun 		 case IPPROTO_UDP:
   1444  1.1   itojun 			 printf("UDP: from port %u, to port %u (decimal)\n",
   1445  1.1   itojun 				(*cp * 256 + *(cp + 1)),
   1446  1.1   itojun 				(*(cp + 2) * 256 + *(cp + 3)));
   1447  1.1   itojun 			 return;
   1448  1.1   itojun 		 default:
   1449  1.1   itojun 			 printf("Unknown Header(%d)\n", nh);
   1450  1.1   itojun 			 return;
   1451  1.1   itojun 		}
   1452  1.1   itojun 
   1453  1.1   itojun 		if ((cp += hlen) >= end)
   1454  1.1   itojun 			goto trunc;
   1455  1.1   itojun 	}
   1456  1.1   itojun 	if (end - cp < 8)
   1457  1.1   itojun 		goto trunc;
   1458  1.1   itojun 
   1459  1.1   itojun 	putchar('\n');
   1460  1.1   itojun 	return;
   1461  1.1   itojun 
   1462  1.1   itojun   trunc:
   1463  1.1   itojun 	printf("...\n");
   1464  1.1   itojun 	return;
   1465  1.1   itojun }
   1466  1.1   itojun 
   1467  1.1   itojun void
   1468  1.1   itojun fill(bp, patp)
   1469  1.1   itojun 	char *bp, *patp;
   1470  1.1   itojun {
   1471  1.1   itojun 	register int ii, jj, kk;
   1472  1.1   itojun 	int pat[16];
   1473  1.1   itojun 	char *cp;
   1474  1.1   itojun 
   1475  1.1   itojun 	for (cp = patp; *cp; cp++)
   1476  1.1   itojun 		if (!isxdigit(*cp))
   1477  1.1   itojun 			errx(1, "patterns must be specified as hex digits");
   1478  1.1   itojun 	ii = sscanf(patp,
   1479  1.1   itojun 	    "%2x%2x%2x%2x%2x%2x%2x%2x%2x%2x%2x%2x%2x%2x%2x%2x",
   1480  1.1   itojun 	    &pat[0], &pat[1], &pat[2], &pat[3], &pat[4], &pat[5], &pat[6],
   1481  1.1   itojun 	    &pat[7], &pat[8], &pat[9], &pat[10], &pat[11], &pat[12],
   1482  1.1   itojun 	    &pat[13], &pat[14], &pat[15]);
   1483  1.1   itojun 
   1484  1.1   itojun /* xxx */
   1485  1.1   itojun 	if (ii > 0)
   1486  1.1   itojun 		for (kk = 0;
   1487  1.1   itojun 		    kk <= MAXDATALEN - (8 + sizeof(struct timeval) + ii);
   1488  1.1   itojun 		    kk += ii)
   1489  1.1   itojun 			for (jj = 0; jj < ii; ++jj)
   1490  1.1   itojun 				bp[jj + kk] = pat[jj];
   1491  1.1   itojun 	if (!(options & F_QUIET)) {
   1492  1.1   itojun 		(void)printf("PATTERN: 0x");
   1493  1.1   itojun 		for (jj = 0; jj < ii; ++jj)
   1494  1.1   itojun 			(void)printf("%02x", bp[jj] & 0xFF);
   1495  1.1   itojun 		(void)printf("\n");
   1496  1.1   itojun 	}
   1497  1.1   itojun }
   1498  1.1   itojun 
   1499  1.1   itojun void
   1500  1.1   itojun usage()
   1501  1.1   itojun {
   1502  1.1   itojun 	(void)fprintf(stderr,
   1503  1.1   itojun "usage: ping6 [-dfnqRrvwW"
   1504  1.1   itojun #ifdef IPSEC
   1505  1.1   itojun #ifdef IPSEC_POLICY_IPSEC
   1506  1.1   itojun 		      "] [-P policy"
   1507  1.1   itojun #else
   1508  1.1   itojun 		      "AE"
   1509  1.1   itojun #endif
   1510  1.1   itojun #endif
   1511  1.1   itojun 		      "] [-a [alsg]] [-b sockbufsiz] [-c count] [-I interface]\n\
   1512  1.1   itojun              [-i wait] [-l preload] [-p pattern] [-s packetsize]\n\
   1513  1.1   itojun              [-h hoplimit] host [hosts...]\n");
   1514  1.1   itojun 	exit(1);
   1515  1.1   itojun }
   1516