Use strchr instead of index, and strrchr instead of rindex because the str*chr
[dragonfly.git] / usr.sbin / traceroute6 / traceroute6.c
1 /*      $KAME: traceroute6.c,v 1.42 2001/05/08 04:36:41 itojun Exp $    */
2
3 /*
4  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  * 3. Neither the name of the project nor the names of its contributors
16  *    may be used to endorse or promote products derived from this software
17  *    without specific prior written permission.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29  * SUCH DAMAGE.
30  *
31  * @(#) Copyright (c) 1990, 1993 The Regents of the University of California.  All rights reserved.
32  * @(#)traceroute.c     8.1 (Berkeley) 6/6/93
33  * $FreeBSD: src/usr.sbin/traceroute6/traceroute6.c,v 1.4.2.4 2001/07/03 11:02:18 ume Exp $
34  * $DragonFly: src/usr.sbin/traceroute6/traceroute6.c,v 1.5 2004/08/30 19:27:22 eirikn Exp $
35  */
36
37 /*-
38  * Copyright (c) 1990, 1993
39  *      The Regents of the University of California.  All rights reserved.
40  *
41  * This code is derived from software contributed to Berkeley by
42  * Van Jacobson.
43  *
44  * Redistribution and use in source and binary forms, with or without
45  * modification, are permitted provided that the following conditions
46  * are met:
47  * 1. Redistributions of source code must retain the above copyright
48  *    notice, this list of conditions and the following disclaimer.
49  * 2. Redistributions in binary form must reproduce the above copyright
50  *    notice, this list of conditions and the following disclaimer in the
51  *    documentation and/or other materials provided with the distribution.
52  * 3. All advertising materials mentioning features or use of this software
53  *    must display the following acknowledgement:
54  *      This product includes software developed by the University of
55  *      California, Berkeley and its contributors.
56  * 4. Neither the name of the University nor the names of its contributors
57  *    may be used to endorse or promote products derived from this software
58  *    without specific prior written permission.
59  *
60  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
61  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
62  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
63  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
64  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
65  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
66  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
67  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
68  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
69  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
70  * SUCH DAMAGE.
71  */
72
73 /*
74  * traceroute host  - trace the route ip packets follow going to "host".
75  *
76  * Attempt to trace the route an ip packet would follow to some
77  * internet host.  We find out intermediate hops by launching probe
78  * packets with a small ttl (time to live) then listening for an
79  * icmp "time exceeded" reply from a gateway.  We start our probes
80  * with a ttl of one and increase by one until we get an icmp "port
81  * unreachable" (which means we got to "host") or hit a max (which
82  * defaults to 30 hops & can be changed with the -m flag).  Three
83  * probes (change with -q flag) are sent at each ttl setting and a
84  * line is printed showing the ttl, address of the gateway and
85  * round trip time of each probe.  If the probe answers come from
86  * different gateways, the address of each responding system will
87  * be printed.  If there is no response within a 5 sec. timeout
88  * interval (changed with the -w flag), a "*" is printed for that
89  * probe.
90  *
91  * Probe packets are UDP format.  We don't want the destination
92  * host to process them so the destination port is set to an
93  * unlikely value (if some clod on the destination is using that
94  * value, it can be changed with the -p flag).
95  *
96  * A sample use might be:
97  *
98  *     [yak 71]% traceroute nis.nsf.net.
99  *     traceroute to nis.nsf.net (35.1.1.48), 30 hops max, 56 byte packet
100  *      1  helios.ee.lbl.gov (128.3.112.1)  19 ms  19 ms  0 ms
101  *      2  lilac-dmc.Berkeley.EDU (128.32.216.1)  39 ms  39 ms  19 ms
102  *      3  lilac-dmc.Berkeley.EDU (128.32.216.1)  39 ms  39 ms  19 ms
103  *      4  ccngw-ner-cc.Berkeley.EDU (128.32.136.23)  39 ms  40 ms  39 ms
104  *      5  ccn-nerif22.Berkeley.EDU (128.32.168.22)  39 ms  39 ms  39 ms
105  *      6  128.32.197.4 (128.32.197.4)  40 ms  59 ms  59 ms
106  *      7  131.119.2.5 (131.119.2.5)  59 ms  59 ms  59 ms
107  *      8  129.140.70.13 (129.140.70.13)  99 ms  99 ms  80 ms
108  *      9  129.140.71.6 (129.140.71.6)  139 ms  239 ms  319 ms
109  *     10  129.140.81.7 (129.140.81.7)  220 ms  199 ms  199 ms
110  *     11  nic.merit.edu (35.1.1.48)  239 ms  239 ms  239 ms
111  *
112  * Note that lines 2 & 3 are the same.  This is due to a buggy
113  * kernel on the 2nd hop system -- lbl-csam.arpa -- that forwards
114  * packets with a zero ttl.
115  *
116  * A more interesting example is:
117  *
118  *     [yak 72]% traceroute allspice.lcs.mit.edu.
119  *     traceroute to allspice.lcs.mit.edu (18.26.0.115), 30 hops max
120  *      1  helios.ee.lbl.gov (128.3.112.1)  0 ms  0 ms  0 ms
121  *      2  lilac-dmc.Berkeley.EDU (128.32.216.1)  19 ms  19 ms  19 ms
122  *      3  lilac-dmc.Berkeley.EDU (128.32.216.1)  39 ms  19 ms  19 ms
123  *      4  ccngw-ner-cc.Berkeley.EDU (128.32.136.23)  19 ms  39 ms  39 ms
124  *      5  ccn-nerif22.Berkeley.EDU (128.32.168.22)  20 ms  39 ms  39 ms
125  *      6  128.32.197.4 (128.32.197.4)  59 ms  119 ms  39 ms
126  *      7  131.119.2.5 (131.119.2.5)  59 ms  59 ms  39 ms
127  *      8  129.140.70.13 (129.140.70.13)  80 ms  79 ms  99 ms
128  *      9  129.140.71.6 (129.140.71.6)  139 ms  139 ms  159 ms
129  *     10  129.140.81.7 (129.140.81.7)  199 ms  180 ms  300 ms
130  *     11  129.140.72.17 (129.140.72.17)  300 ms  239 ms  239 ms
131  *     12  * * *
132  *     13  128.121.54.72 (128.121.54.72)  259 ms  499 ms  279 ms
133  *     14  * * *
134  *     15  * * *
135  *     16  * * *
136  *     17  * * *
137  *     18  ALLSPICE.LCS.MIT.EDU (18.26.0.115)  339 ms  279 ms  279 ms
138  *
139  * (I start to see why I'm having so much trouble with mail to
140  * MIT.)  Note that the gateways 12, 14, 15, 16 & 17 hops away
141  * either don't send ICMP "time exceeded" messages or send them
142  * with a ttl too small to reach us.  14 - 17 are running the
143  * MIT C Gateway code that doesn't send "time exceeded"s.  God
144  * only knows what's going on with 12.
145  *
146  * The silent gateway 12 in the above may be the result of a bug in
147  * the 4.[23]BSD network code (and its derivatives):  4.x (x <= 3)
148  * sends an unreachable message using whatever ttl remains in the
149  * original datagram.  Since, for gateways, the remaining ttl is
150  * zero, the icmp "time exceeded" is guaranteed to not make it back
151  * to us.  The behavior of this bug is slightly more interesting
152  * when it appears on the destination system:
153  *
154  *      1  helios.ee.lbl.gov (128.3.112.1)  0 ms  0 ms  0 ms
155  *      2  lilac-dmc.Berkeley.EDU (128.32.216.1)  39 ms  19 ms  39 ms
156  *      3  lilac-dmc.Berkeley.EDU (128.32.216.1)  19 ms  39 ms  19 ms
157  *      4  ccngw-ner-cc.Berkeley.EDU (128.32.136.23)  39 ms  40 ms  19 ms
158  *      5  ccn-nerif35.Berkeley.EDU (128.32.168.35)  39 ms  39 ms  39 ms
159  *      6  csgw.Berkeley.EDU (128.32.133.254)  39 ms  59 ms  39 ms
160  *      7  * * *
161  *      8  * * *
162  *      9  * * *
163  *     10  * * *
164  *     11  * * *
165  *     12  * * *
166  *     13  rip.Berkeley.EDU (128.32.131.22)  59 ms !  39 ms !  39 ms !
167  *
168  * Notice that there are 12 "gateways" (13 is the final
169  * destination) and exactly the last half of them are "missing".
170  * What's really happening is that rip (a Sun-3 running Sun OS3.5)
171  * is using the ttl from our arriving datagram as the ttl in its
172  * icmp reply.  So, the reply will time out on the return path
173  * (with no notice sent to anyone since icmp's aren't sent for
174  * icmp's) until we probe with a ttl that's at least twice the path
175  * length.  I.e., rip is really only 7 hops away.  A reply that
176  * returns with a ttl of 1 is a clue this problem exists.
177  * Traceroute prints a "!" after the time if the ttl is <= 1.
178  * Since vendors ship a lot of obsolete (DEC's Ultrix, Sun 3.x) or
179  * non-standard (HPUX) software, expect to see this problem
180  * frequently and/or take care picking the target host of your
181  * probes.
182  *
183  * Other possible annotations after the time are !H, !N, !P (got a host,
184  * network or protocol unreachable, respectively), !S or !F (source
185  * route failed or fragmentation needed -- neither of these should
186  * ever occur and the associated gateway is busted if you see one).  If
187  * almost all the probes result in some kind of unreachable, traceroute
188  * will give up and exit.
189  *
190  * Notes
191  * -----
192  * This program must be run by root or be setuid.  (I suggest that
193  * you *don't* make it setuid -- casual use could result in a lot
194  * of unnecessary traffic on our poor, congested nets.)
195  *
196  * This program requires a kernel mod that does not appear in any
197  * system available from Berkeley:  A raw ip socket using proto
198  * IPPROTO_RAW must interpret the data sent as an ip datagram (as
199  * opposed to data to be wrapped in a ip datagram).  See the README
200  * file that came with the source to this program for a description
201  * of the mods I made to /sys/netinet/raw_ip.c.  Your mileage may
202  * vary.  But, again, ANY 4.x (x < 4) BSD KERNEL WILL HAVE TO BE
203  * MODIFIED TO RUN THIS PROGRAM.
204  *
205  * The udp port usage may appear bizarre (well, ok, it is bizarre).
206  * The problem is that an icmp message only contains 8 bytes of
207  * data from the original datagram.  8 bytes is the size of a udp
208  * header so, if we want to associate replies with the original
209  * datagram, the necessary information must be encoded into the
210  * udp header (the ip id could be used but there's no way to
211  * interlock with the kernel's assignment of ip id's and, anyway,
212  * it would have taken a lot more kernel hacking to allow this
213  * code to set the ip id).  So, to allow two or more users to
214  * use traceroute simultaneously, we use this task's pid as the
215  * source port (the high bit is set to move the port number out
216  * of the "likely" range).  To keep track of which probe is being
217  * replied to (so times and/or hop counts don't get confused by a
218  * reply that was delayed in transit), we increment the destination
219  * port number before each probe.
220  *
221  * Don't use this as a coding example.  I was trying to find a
222  * routing problem and this code sort-of popped out after 48 hours
223  * without sleep.  I was amazed it ever compiled, much less ran.
224  *
225  * I stole the idea for this program from Steve Deering.  Since
226  * the first release, I've learned that had I attended the right
227  * IETF working group meetings, I also could have stolen it from Guy
228  * Almes or Matt Mathis.  I don't know (or care) who came up with
229  * the idea first.  I envy the originators' perspicacity and I'm
230  * glad they didn't keep the idea a secret.
231  *
232  * Tim Seaver, Ken Adelman and C. Philip Wood provided bug fixes and/or
233  * enhancements to the original distribution.
234  *
235  * I've hacked up a round-trip-route version of this that works by
236  * sending a loose-source-routed udp datagram through the destination
237  * back to yourself.  Unfortunately, SO many gateways botch source
238  * routing, the thing is almost worthless.  Maybe one day...
239  *
240  *  -- Van Jacobson (van@helios.ee.lbl.gov)
241  *     Tue Dec 20 03:50:13 PST 1988
242  */
243
244 #include <sys/param.h>
245 #include <sys/time.h>
246 #include <sys/socket.h>
247 #include <sys/uio.h>
248 #include <sys/file.h>
249 #include <sys/ioctl.h>
250
251 #include <netinet/in.h>
252
253 #include <arpa/inet.h>
254
255 #include <netdb.h>
256 #include <stdio.h>
257 #include <err.h>
258 #ifdef HAVE_POLL
259 #include <poll.h>
260 #endif
261 #include <errno.h>
262 #include <stdlib.h>
263 #include <string.h>
264 #include <unistd.h>
265
266 #include <netinet/ip6.h>
267 #include <netinet/icmp6.h>
268 #include <netinet/udp.h>
269
270 #ifdef IPSEC
271 #include <net/route.h>
272 #include <netinet6/ipsec.h>
273 #endif
274
275 #define DUMMY_PORT 10010
276
277 #define MAXPACKET       65535   /* max ip packet size */
278 #ifndef MAXHOSTNAMELEN
279 #define MAXHOSTNAMELEN  64
280 #endif
281
282 #ifndef FD_SET
283 #define NFDBITS         (8*sizeof(fd_set))
284 #define FD_SETSIZE      NFDBITS
285 #define FD_SET(n, p)    ((p)->fds_bits[(n)/NFDBITS] |= (1 << ((n) % NFDBITS)))
286 #define FD_CLR(n, p)    ((p)->fds_bits[(n)/NFDBITS] &= ~(1 << ((n) % NFDBITS)))
287 #define FD_ISSET(n, p)  ((p)->fds_bits[(n)/NFDBITS] & (1 << ((n) % NFDBITS)))
288 #define FD_ZERO(p)      bzero((char *)(p), sizeof(*(p)))
289 #endif
290
291 #define Fprintf (void)fprintf
292 #define Sprintf (void)sprintf
293 #define Printf (void)printf
294
295 #ifndef HAVE_GETIPNODEBYNAME
296 #define getipnodebyname(x, y, z, u)     gethostbyname2((x), (y))
297 #define freehostent(x)
298 #endif
299
300 /*
301  * format of a (udp) probe packet.
302  */
303 struct opacket {
304         u_char seq;             /* sequence number of this packet */
305         u_char hops;            /* hop limit of the packet */
306         struct timeval tv;      /* time packet left */
307 };
308
309 u_char  packet[512];            /* last inbound (icmp) packet */
310 struct opacket  *outpacket;     /* last output (udp) packet */
311
312 int     main(int, char **);
313 int     wait_for_reply(int, struct msghdr *);
314 #ifdef IPSEC
315 #ifdef IPSEC_POLICY_IPSEC
316 int     setpolicy(int so, char *policy);
317 #endif
318 #endif
319 void    send_probe(int, int);
320 struct udphdr *get_udphdr(struct ip6_hdr *, u_char *);
321 int     get_hoplim(struct msghdr *);
322 double  deltaT(struct timeval *, struct timeval *);
323 char    *pr_type(int);
324 int     packet_ok(struct msghdr *, int, int);
325 void    print(struct msghdr *, int);
326 void    tvsub(struct timeval *, struct timeval *);
327 const char *inetname(struct sockaddr *);
328 void    usage(void);
329
330 int rcvsock;                    /* receive (icmp) socket file descriptor */
331 int sndsock;                    /* send (udp) socket file descriptor */
332 struct timezone tz;             /* leftover */
333
334 struct msghdr rcvmhdr;
335 struct iovec rcviov[2];
336 int rcvhlim;
337 struct in6_pktinfo *rcvpktinfo;
338
339 struct sockaddr_in6 Src, Dst, Rcv;
340 int datalen;                    /* How much data */
341 /* XXX: 2064 = 127(max hops in type 0 rthdr) * sizeof(ip6_hdr) + 16(margin) */
342 char rtbuf[2064];
343 #ifdef USE_RFC2292BIS
344 struct ip6_rthdr *rth;
345 #endif
346 struct cmsghdr *cmsg;
347
348 char *source = 0;
349 char *hostname;
350
351 int nprobes = 3;
352 int first_hop = 1;
353 int max_hops = 30;
354 u_short ident;
355 u_short port = 32768+666;       /* start udp dest port # for probe packets */
356 int options;                    /* socket options */
357 int verbose;
358 int waittime = 5;               /* time to wait for response (in seconds) */
359 int nflag;                      /* print addresses numerically */
360 int lflag;                      /* print both numerical address & hostname */
361
362 #ifdef KAME_SCOPEID
363 const int niflag = NI_WITHSCOPEID;
364 #else
365 const int niflag = 0;
366 #endif
367
368 int
369 main(int argc, char **argv)
370 {
371         struct hostent *hp;
372         int error;
373         struct addrinfo hints, *res;
374         int ch, i, on, probe, seq, hops, rcvcmsglen;
375         static u_char *rcvcmsgbuf;
376         char hbuf[NI_MAXHOST], src0[NI_MAXHOST];
377         char *ep;
378
379         /*
380          * Receive ICMP
381          */
382         if ((rcvsock = socket(AF_INET6, SOCK_RAW, IPPROTO_ICMPV6)) < 0) {
383                 perror("socket(ICMPv6)");
384                 exit(5);
385         }
386
387         /* revoke privs */
388         seteuid(getuid());
389         setuid(getuid());
390
391         /* set a minimum set of socket options */
392         on = 1;
393         /* specify to tell receiving interface */
394 #ifdef IPV6_RECVPKTINFO
395         if (setsockopt(rcvsock, IPPROTO_IPV6, IPV6_RECVPKTINFO, &on,
396                        sizeof(on)) < 0)
397                 err(1, "setsockopt(IPV6_RECVPKTINFO)");
398 #else  /* old adv. API */
399         if (setsockopt(rcvsock, IPPROTO_IPV6, IPV6_PKTINFO, &on,
400                        sizeof(on)) < 0)
401                 err(1, "setsockopt(IPV6_PKTINFO)");
402 #endif
403
404         /* specify to tell value of hoplimit field of received IP6 hdr */
405 #ifdef IPV6_RECVHOPLIMIT
406         if (setsockopt(rcvsock, IPPROTO_IPV6, IPV6_RECVHOPLIMIT, &on,
407                        sizeof(on)) < 0)
408                 err(1, "setsockopt(IPV6_RECVHOPLIMIT)");
409 #else  /* old adv. API */
410         if (setsockopt(rcvsock, IPPROTO_IPV6, IPV6_HOPLIMIT, &on,
411                        sizeof(on)) < 0)
412                 err(1, "setsockopt(IPV6_HOPLIMIT)");
413 #endif
414
415         seq = 0;
416         
417         while ((ch = getopt(argc, argv, "df:g:lm:np:q:rs:w:v")) != -1)
418                 switch(ch) {
419                 case 'd':
420                         options |= SO_DEBUG;
421                         break;
422                 case 'f':
423                         ep = NULL;
424                         first_hop = strtoul(optarg, &ep, 0);
425                         if (!*argv || *ep) {
426                                 Fprintf(stderr,
427                                     "traceroute6: invalid min hoplimit.\n");
428                                 exit(1);
429                         }
430                         if (first_hop > max_hops) {
431                                 Fprintf(stderr,
432                                     "traceroute6: min hoplimit must be <= %d.\n", max_hops);
433                                 exit(1);
434                         }
435                         break;
436                 case 'g':
437                         hp = getipnodebyname(optarg, AF_INET6, 0, &h_errno);
438                         if (hp == NULL) {
439                                 Fprintf(stderr,
440                                     "traceroute6: unknown host %s\n", optarg);
441                                 exit(1);
442                         }
443 #ifdef USE_RFC2292BIS
444                         if (rth == NULL) {
445                                 /*
446                                  * XXX: We can't detect the number of
447                                  * intermediate nodes yet.
448                                  */
449                                 if ((rth = inet6_rth_init((void *)rtbuf,
450                                                          sizeof(rtbuf),
451                                                          IPV6_RTHDR_TYPE_0,
452                                                          0)) == NULL) {
453                                         Fprintf(stderr,
454                                                 "inet6_rth_init failed.\n");
455                                         exit(1);
456                                 }
457                         }
458                         if (inet6_rth_add((void *)rth,
459                                           (struct in6_addr *)hp->h_addr)) {
460                                 Fprintf(stderr,
461                                         "inet6_rth_add failed for %s\n",
462                                         optarg);
463                                 exit(1);
464                         }
465 #else  /* old advanced API */
466                         if (cmsg == NULL)
467                                 cmsg = inet6_rthdr_init(rtbuf, IPV6_RTHDR_TYPE_0);
468                         inet6_rthdr_add(cmsg, (struct in6_addr *)hp->h_addr, IPV6_RTHDR_LOOSE);
469 #endif
470                         freehostent(hp);
471                         break;
472                 case 'l':
473                         lflag++;
474                         break;
475                 case 'm':
476                         ep = NULL;
477                         max_hops = strtoul(optarg, &ep, 0);
478                         if (!*argv || *ep) {
479                                 Fprintf(stderr,
480                                     "traceroute6: invalid max hoplimit.\n");
481                                 exit(1);
482                         }
483                         if (max_hops < first_hop) {
484                                 Fprintf(stderr,
485                                     "traceroute6: max hoplimit must be >= %d.\n", first_hop);
486                                 exit(1);
487                         }
488                         break;
489                 case 'n':
490                         nflag++;
491                         break;
492                 case 'p':
493                         ep = NULL;
494                         port = strtoul(optarg, &ep, 0);
495                         if (!*argv || *ep) {
496                                 Fprintf(stderr,
497                                     "traceroute6: port.\n");
498                                 exit(1);
499                         }
500                         if (port < 1) {
501                                 Fprintf(stderr,
502                                     "traceroute6: port must be >0.\n");
503                                 exit(1);
504                         }
505                         break;
506                 case 'q':
507                         ep = NULL;
508                         nprobes = strtoul(optarg, &ep, 0);
509                         if (!*argv || *ep) {
510                                 Fprintf(stderr,
511                                     "traceroute6: invalid nprobes.\n");
512                                 exit(1);
513                         }
514                         if (nprobes < 1) {
515                                 Fprintf(stderr,
516                                     "traceroute6: nprobes must be >0.\n");
517                                 exit(1);
518                         }
519                         break;
520                 case 'r':
521                         options |= SO_DONTROUTE;
522                         break;
523                 case 's':
524                         /*
525                          * set the ip source address of the outbound
526                          * probe (e.g., on a multi-homed host).
527                          */
528                         source = optarg;
529                         break;
530                 case 'v':
531                         verbose++;
532                         break;
533                 case 'w':
534                         ep = NULL;
535                         waittime = strtoul(optarg, &ep, 0);
536                         if (!*argv || *ep) {
537                                 Fprintf(stderr,
538                                     "traceroute6: invalid wait time.\n");
539                                 exit(1);
540                         }
541                         if (waittime <= 1) {
542                                 Fprintf(stderr,
543                                     "traceroute6: wait must be >1 sec.\n");
544                                 exit(1);
545                         }
546                         break;
547                 default:
548                         usage();
549                 }
550         argc -= optind;
551         argv += optind;
552
553         if (argc < 1 || argc > 2)
554                 usage();
555
556 #if 1
557         setvbuf(stdout, NULL, _IOLBF, BUFSIZ);
558 #else
559         setlinebuf (stdout);
560 #endif
561
562         memset(&hints, 0, sizeof(hints));
563         hints.ai_family = PF_INET6;
564         hints.ai_socktype = SOCK_RAW;
565         hints.ai_protocol = IPPROTO_ICMPV6;
566         hints.ai_flags = AI_CANONNAME;
567         error = getaddrinfo(*argv, NULL, &hints, &res);
568         if (error) {
569                 (void)fprintf(stderr,
570                               "traceroute6: %s\n", gai_strerror(error));
571                 exit(1);
572         }
573         if (res->ai_addrlen != sizeof(Dst)) {
574                 (void)fprintf(stderr,
575                               "traceroute6: size of sockaddr mismatch\n");
576                 exit(1);
577         }
578         memcpy(&Dst, res->ai_addr, res->ai_addrlen);
579         hostname = res->ai_canonname ? strdup(res->ai_canonname) : *argv;
580         if (!hostname) {
581                 (void)fprintf(stderr, "traceroute6: not enough core\n");
582                 exit(1);
583         }
584
585         if (*++argv) {
586                 ep = NULL;
587                 datalen = strtoul(*argv, &ep, 0);
588                 if (!*argv || *ep) {
589                         Fprintf(stderr,
590                             "traceroute6: invalid packet length.\n");
591                         exit(1);
592                 }
593         }
594         if (datalen < 0 || datalen >= MAXPACKET - sizeof(struct opacket)) {
595                 Fprintf(stderr,
596                     "traceroute6: packet size must be 0 <= s < %ld.\n",
597                     (long)(MAXPACKET - sizeof(struct opacket)));
598                 exit(1);
599         }
600         datalen += sizeof(struct opacket);
601         outpacket = (struct opacket *)malloc((unsigned)datalen);
602         if (! outpacket) {
603                 perror("malloc");
604                 exit(1);
605         }
606         (void) bzero((char *)outpacket, datalen);
607
608         /* initialize msghdr for receiving packets */
609         rcviov[0].iov_base = (caddr_t)packet;
610         rcviov[0].iov_len = sizeof(packet);
611         rcvmhdr.msg_name = (caddr_t)&Rcv;
612         rcvmhdr.msg_namelen = sizeof(Rcv);
613         rcvmhdr.msg_iov = rcviov;
614         rcvmhdr.msg_iovlen = 1;
615         rcvcmsglen = CMSG_SPACE(sizeof(struct in6_pktinfo))
616                 + CMSG_SPACE(sizeof(int));
617         if ((rcvcmsgbuf = malloc(rcvcmsglen)) == NULL) {
618                 Fprintf(stderr, "traceroute6: malloc failed\n");
619                 exit(1);
620         }
621         rcvmhdr.msg_control = (caddr_t) rcvcmsgbuf;
622         rcvmhdr.msg_controllen = rcvcmsglen;
623
624         if (options & SO_DEBUG)
625                 (void) setsockopt(rcvsock, SOL_SOCKET, SO_DEBUG,
626                                   (char *)&on, sizeof(on));
627         if (options & SO_DONTROUTE)
628                 (void) setsockopt(rcvsock, SOL_SOCKET, SO_DONTROUTE,
629                                   (char *)&on, sizeof(on));
630 #ifdef IPSEC
631 #ifdef IPSEC_POLICY_IPSEC
632         /*
633          * do not raise error even if setsockopt fails, kernel may have ipsec
634          * turned off.
635          */
636         if (setpolicy(rcvsock, "in bypass") < 0)
637                 errx(1, "%s", ipsec_strerror());
638         if (setpolicy(rcvsock, "out bypass") < 0)
639                 errx(1, "%s", ipsec_strerror());
640 #else
641     {
642         int level = IPSEC_LEVEL_NONE;
643
644         (void)setsockopt(rcvsock, IPPROTO_IPV6, IPV6_ESP_TRANS_LEVEL, &level,
645                 sizeof(level));
646         (void)setsockopt(rcvsock, IPPROTO_IPV6, IPV6_ESP_NETWORK_LEVEL, &level,
647                 sizeof(level));
648 #ifdef IP_AUTH_TRANS_LEVEL
649         (void)setsockopt(rcvsock, IPPROTO_IPV6, IPV6_AUTH_TRANS_LEVEL, &level,
650                 sizeof(level));
651 #else
652         (void)setsockopt(rcvsock, IPPROTO_IPV6, IPV6_AUTH_LEVEL, &level,
653                 sizeof(level));
654 #endif
655 #ifdef IP_AUTH_NETWORK_LEVEL
656         (void)setsockopt(rcvsock, IPPROTO_IPV6, IPV6_AUTH_NETWORK_LEVEL, &level,
657                 sizeof(level));
658 #endif
659     }
660 #endif /*IPSEC_POLICY_IPSEC*/
661 #endif /*IPSEC*/
662
663         /*
664          * Send UDP
665          */
666         if ((sndsock = socket(AF_INET6, SOCK_DGRAM, 0)) < 0) {
667                 perror("socket(SOCK_DGRAM)");
668                 exit(5);
669         }
670 #ifdef SO_SNDBUF
671         if (setsockopt(sndsock, SOL_SOCKET, SO_SNDBUF, (char *)&datalen,
672                        sizeof(datalen)) < 0) {
673                 perror("setsockopt(SO_SNDBUF)");
674                 exit(6);
675         }
676 #endif /* SO_SNDBUF */
677         if (options & SO_DEBUG)
678                 (void) setsockopt(sndsock, SOL_SOCKET, SO_DEBUG,
679                                   (char *)&on, sizeof(on));
680         if (options & SO_DONTROUTE)
681                 (void) setsockopt(sndsock, SOL_SOCKET, SO_DONTROUTE,
682                                   (char *)&on, sizeof(on));
683 #ifdef USE_RFC2292BIS
684         if (rth) {/* XXX: there is no library to finalize the header... */
685                 rth->ip6r_len = rth->ip6r_segleft * 2;
686                 if (setsockopt(sndsock, IPPROTO_IPV6, IPV6_RTHDR,
687                                (void *)rth, (rth->ip6r_len + 1) << 3)) {
688                         Fprintf(stderr, "setsockopt(IPV6_RTHDR): %s\n",
689                                 strerror(errno));
690                         exit(1);
691                 }
692         }
693 #else  /* old advanced API */
694         if (cmsg != NULL) {
695                 inet6_rthdr_lasthop(cmsg, IPV6_RTHDR_LOOSE);
696                 if (setsockopt(sndsock, IPPROTO_IPV6, IPV6_PKTOPTIONS,
697                                rtbuf, cmsg->cmsg_len) < 0) {
698                         Fprintf(stderr, "setsockopt(IPV6_PKTOPTIONS): %s\n",
699                                 strerror(errno));
700                         exit(1);
701                 }
702         }
703 #endif /* USE_RFC2292BIS */
704 #ifdef IPSEC
705 #ifdef IPSEC_POLICY_IPSEC
706         /*
707          * do not raise error even if setsockopt fails, kernel may have ipsec
708          * turned off.
709          */
710         if (setpolicy(sndsock, "in bypass") < 0)
711                 errx(1, "%s", ipsec_strerror());
712         if (setpolicy(sndsock, "out bypass") < 0)
713                 errx(1, "%s", ipsec_strerror());
714 #else
715     {
716         int level = IPSEC_LEVEL_BYPASS;
717
718         (void)setsockopt(sndsock, IPPROTO_IPV6, IPV6_ESP_TRANS_LEVEL, &level,
719                 sizeof(level));
720         (void)setsockopt(sndsock, IPPROTO_IPV6, IPV6_ESP_NETWORK_LEVEL, &level,
721                 sizeof(level));
722 #ifdef IP_AUTH_TRANS_LEVEL
723         (void)setsockopt(sndsock, IPPROTO_IPV6, IPV6_AUTH_TRANS_LEVEL, &level,
724                 sizeof(level));
725 #else
726         (void)setsockopt(sndsock, IPPROTO_IPV6, IPV6_AUTH_LEVEL, &level,
727                 sizeof(level));
728 #endif
729 #ifdef IP_AUTH_NETWORK_LEVEL
730         (void)setsockopt(sndsock, IPPROTO_IPV6, IPV6_AUTH_NETWORK_LEVEL, &level,
731                 sizeof(level));
732 #endif
733     }
734 #endif /*IPSEC_POLICY_IPSEC*/
735 #endif /*IPSEC*/
736
737         /*
738          * Source selection
739          */
740         bzero(&Src, sizeof(Src));
741         if (source) {
742                 struct addrinfo hints, *res;
743                 int error;
744
745                 memset(&hints, 0, sizeof(hints));
746                 hints.ai_family = AF_INET6;
747                 hints.ai_socktype = SOCK_DGRAM; /*dummy*/
748                 hints.ai_flags = AI_NUMERICHOST;
749                 error = getaddrinfo(source, "0", &hints, &res);
750                 if (error) {
751                         Printf("traceroute6: %s: %s\n", source,
752                             gai_strerror(error));
753                         exit(1);
754                 }
755                 if (res->ai_addrlen > sizeof(Src)) {
756                         Printf("traceroute6: %s: %s\n", source,
757                             gai_strerror(error));
758                         exit(1);
759                 }
760                 memcpy(&Src, res->ai_addr, res->ai_addrlen);
761                 freeaddrinfo(res);
762         } else {
763                 struct sockaddr_in6 Nxt;
764                 int dummy, len;
765
766                 Nxt = Dst;
767                 Nxt.sin6_port = htons(DUMMY_PORT);
768                 if (cmsg != NULL)
769                         bcopy(inet6_rthdr_getaddr(cmsg, 1), &Nxt.sin6_addr,
770                               sizeof(Nxt.sin6_addr));
771                 if ((dummy = socket(AF_INET6, SOCK_DGRAM, 0)) < 0) {
772                         perror("socket");
773                         exit(1);
774                 }
775                 if (connect(dummy, (struct sockaddr *)&Nxt, Nxt.sin6_len) < 0) {
776                         perror("connect");
777                         exit(1);
778                 }
779                 len = sizeof(Src);
780                 if (getsockname(dummy, (struct sockaddr *)&Src, &len) < 0) {
781                         perror("getsockname");
782                         exit(1);
783                 }
784                 if (getnameinfo((struct sockaddr *)&Src, Src.sin6_len,
785                                 src0, sizeof(src0), NULL, 0,
786                                 NI_NUMERICHOST | niflag)) {
787                         Fprintf(stderr, "getnameinfo failed for source\n");
788                         exit(1);
789                 }
790                 source = src0;
791                 close(dummy);
792         }
793
794 #if 1
795         ident = (getpid() & 0xffff) | 0x8000;
796 #else
797         ident = 0;      /*let the kernel pick one*/
798 #endif
799         Src.sin6_port = htons(ident);
800         if (bind(sndsock, (struct sockaddr *)&Src, Src.sin6_len) < 0) {
801                 perror("bind");
802                 exit(1);
803         }
804
805         if (ident == 0) {
806                 int len;
807
808                 len = sizeof(Src);
809                 if (getsockname(sndsock, (struct sockaddr *)&Src, &i) < 0) {
810                         perror("getsockname");
811                         exit(1);
812                 }
813                 ident = ntohs(Src.sin6_port);
814         }
815
816         /*
817          * Message to users
818          */
819         if (getnameinfo((struct sockaddr *)&Dst, Dst.sin6_len, hbuf,
820                         sizeof(hbuf), NULL, 0, NI_NUMERICHOST | niflag))
821                 strlcpy(hbuf, "(invalid)", sizeof(hbuf));
822         Fprintf(stderr, "traceroute6");
823         Fprintf(stderr, " to %s (%s)", hostname, hbuf);
824         if (source)
825                 Fprintf(stderr, " from %s", source);
826         Fprintf(stderr,
827                 ", %d hops max, %d byte packets\n",
828                 max_hops, datalen);
829         (void) fflush(stderr);
830
831         if (first_hop > 1)
832                 Printf("Skipping %d intermediate hops\n", first_hop - 1);
833
834         /*
835          * Main loop
836          */
837         for (hops = first_hop; hops <= max_hops; ++hops) {
838                 struct in6_addr lastaddr;
839                 int got_there = 0;
840                 int unreachable = 0;
841
842                 Printf("%2d ", hops);
843                 bzero(&lastaddr, sizeof(lastaddr));
844                 for (probe = 0; probe < nprobes; ++probe) {
845                         int cc;
846                         struct timeval t1, t2;
847                         struct timezone tz;
848
849                         (void) gettimeofday(&t1, &tz);
850                         send_probe(++seq, hops);
851                         while ((cc = wait_for_reply(rcvsock, &rcvmhdr))) {
852                                 (void) gettimeofday(&t2, &tz);
853                                 if ((i = packet_ok(&rcvmhdr, cc, seq))) {
854                                         if (! IN6_ARE_ADDR_EQUAL(&Rcv.sin6_addr,
855                                                             &lastaddr)) {
856                                                 print(&rcvmhdr, cc);
857                                                 lastaddr = Rcv.sin6_addr;
858                                         }
859                                         Printf("  %g ms", deltaT(&t1, &t2));
860                                         switch(i - 1) {
861                                         case ICMP6_DST_UNREACH_NOROUTE:
862                                                 ++unreachable;
863                                                 Printf(" !N");
864                                                 break;
865                                         case ICMP6_DST_UNREACH_ADMIN:
866                                                 ++unreachable;
867                                                 Printf(" !P");
868                                                 break;
869                                         case ICMP6_DST_UNREACH_NOTNEIGHBOR:
870                                                 ++unreachable;
871                                                 Printf(" !S");
872                                                 break;
873                                         case ICMP6_DST_UNREACH_ADDR:
874                                                 ++unreachable;
875                                                 Printf(" !A");
876                                                 break;
877                                         case ICMP6_DST_UNREACH_NOPORT:
878                                                 if (rcvhlim >= 0 &&
879                                                     rcvhlim <= 1)
880                                                         Printf(" !");
881                                                 ++got_there;
882                                                 break;
883                                         }
884                                         break;
885                                 }
886                         }
887                         if (cc == 0)
888                                 Printf(" *");
889                         (void) fflush(stdout);
890                 }
891                 putchar('\n');
892                 if (got_there ||
893                     (unreachable > 0 && unreachable >= ((nprobes + 1) / 2))) {
894                         exit(0);
895                 }
896         }
897
898         exit(0);
899 }
900
901 int
902 wait_for_reply(int sock, struct msghdr *mhdr)
903 {
904 #ifdef HAVE_POLL
905         struct pollfd pfd[1];
906         int cc = 0;
907
908         pfd[0].fd = sock;
909         pfd[0].events = POLLIN;
910         pfd[0].revents = 0;
911
912         if (poll(pfd, 1, waittime * 1000) > 0)
913                 cc = recvmsg(rcvsock, mhdr, 0);
914
915         return(cc);
916 #else
917         fd_set *fdsp;
918         struct timeval wait;
919         int cc = 0, fdsn;
920
921         fdsn = howmany(sock + 1, NFDBITS) * sizeof(fd_mask);
922         if ((fdsp = (fd_set *)malloc(fdsn)) == NULL)
923                 err(1, "malloc");
924         memset(fdsp, 0, fdsn);
925         FD_SET(sock, fdsp);
926         wait.tv_sec = waittime; wait.tv_usec = 0;
927
928         if (select(sock+1, fdsp, (fd_set *)0, (fd_set *)0, &wait) > 0)
929                 cc = recvmsg(rcvsock, mhdr, 0);
930
931         free(fdsp);
932         return(cc);
933 #endif
934 }
935
936 #ifdef IPSEC
937 #ifdef IPSEC_POLICY_IPSEC
938 int
939 setpolicy(int so, char *policy)
940 {
941         char *buf;
942
943         buf = ipsec_set_policy(policy, strlen(policy));
944         if (buf == NULL) {
945                 warnx("%s", ipsec_strerror());
946                 return -1;
947         }
948         (void)setsockopt(so, IPPROTO_IPV6, IPV6_IPSEC_POLICY,
949                 buf, ipsec_get_policylen(buf));
950
951         free(buf);
952
953         return 0;
954 }
955 #endif
956 #endif
957
958 void
959 send_probe(int seq, int hops)
960 {
961         struct opacket *op = outpacket;
962         int i;
963
964         if(setsockopt(sndsock, IPPROTO_IPV6, IPV6_UNICAST_HOPS,
965                       (char *)&hops, sizeof(hops)) < 0) {
966                 perror("setsockopt IPV6_UNICAST_HOPS");
967         }
968
969         Dst.sin6_port = htons(port + seq);
970
971         op->seq = seq;
972         op->hops = hops;
973         (void) gettimeofday(&op->tv, &tz);
974
975         i = sendto(sndsock, (char *)outpacket, datalen , 0,
976                    (struct sockaddr *)&Dst, Dst.sin6_len);
977         if (i < 0 || i != datalen)  {
978                 if (i<0)
979                         perror("sendto");
980                 Printf("traceroute6: wrote %s %d chars, ret=%d\n", hostname,
981                        datalen, i);
982                 (void) fflush(stdout);
983         }
984 }
985
986 int
987 get_hoplim(struct msghdr *mhdr)
988 {
989         struct cmsghdr *cm;
990
991         for (cm = (struct cmsghdr *)CMSG_FIRSTHDR(mhdr); cm;
992              cm = (struct cmsghdr *)CMSG_NXTHDR(mhdr, cm)) {
993                 if (cm->cmsg_level == IPPROTO_IPV6 &&
994                     cm->cmsg_type == IPV6_HOPLIMIT &&
995                     cm->cmsg_len == CMSG_LEN(sizeof(int)))
996                         return(*(int *)CMSG_DATA(cm));
997         }
998
999         return(-1);
1000 }
1001
1002 double
1003 deltaT(struct timeval *t1p, struct timeval *t2p)
1004 {
1005         double dt;
1006
1007         dt = (double)(t2p->tv_sec - t1p->tv_sec) * 1000.0 +
1008              (double)(t2p->tv_usec - t1p->tv_usec) / 1000.0;
1009         return (dt);
1010 }
1011
1012
1013 /*
1014  * Convert an ICMP "type" field to a printable string.
1015  */
1016 char *
1017 pr_type(int t0)
1018 {
1019         u_char t = t0 & 0xff;
1020         char *cp;
1021
1022         switch (t) {
1023         case ICMP6_DST_UNREACH:
1024                 cp = "Destination Unreachable";
1025                 break;
1026         case ICMP6_PACKET_TOO_BIG:
1027                 cp = "Pakcet Too Big";
1028                 break;
1029         case ICMP6_TIME_EXCEEDED:
1030                 cp = "Time Exceeded";
1031                 break;
1032         case ICMP6_PARAM_PROB:
1033                 cp = "Parameter Problem";
1034                 break;
1035         case ICMP6_ECHO_REQUEST:
1036                 cp = "Echo Request";
1037                 break;
1038         case ICMP6_ECHO_REPLY:
1039                 cp = "Echo Reply";
1040                 break;
1041         case ICMP6_MEMBERSHIP_QUERY:
1042                 cp = "Group Membership Query";
1043                 break;
1044         case ICMP6_MEMBERSHIP_REPORT:
1045                 cp = "Group Membership Report";
1046                 break;
1047         case ICMP6_MEMBERSHIP_REDUCTION:
1048                 cp = "Group Membership Reduction";
1049                 break;
1050         case ND_ROUTER_SOLICIT:
1051                 cp = "Router Solicitation";
1052                 break;
1053         case ND_ROUTER_ADVERT:
1054                 cp = "Router Advertisement";
1055                 break;
1056         case ND_NEIGHBOR_SOLICIT:
1057                 cp = "Neighbor Solicitation";
1058                 break;
1059         case ND_NEIGHBOR_ADVERT:
1060                 cp = "Neighbor Advertisement";
1061                 break;
1062         case ND_REDIRECT:
1063                 cp = "Redirect";
1064                 break;
1065         default:
1066                 cp = "Unknown";
1067                 break;
1068         }
1069         return cp;
1070 }
1071
1072
1073 int
1074 packet_ok(struct msghdr *mhdr, int cc, int seq)
1075 {
1076         struct icmp6_hdr *icp;
1077         struct sockaddr_in6 *from = (struct sockaddr_in6 *)mhdr->msg_name;
1078         u_char type, code;
1079         char *buf = (char *)mhdr->msg_iov[0].iov_base;
1080         struct cmsghdr *cm;
1081         int *hlimp;
1082         char hbuf[NI_MAXHOST];
1083
1084 #ifdef OLDRAWSOCKET
1085         int hlen;
1086         struct ip6_hdr *ip;
1087 #endif
1088
1089 #ifdef OLDRAWSOCKET
1090         ip = (struct ip6_hdr *) buf;
1091         hlen = sizeof(struct ip6_hdr);
1092         if (cc < hlen + sizeof(struct icmp6_hdr)) {
1093                 if (verbose) {
1094                         if (getnameinfo((struct sockaddr *)from, from->sin6_len,
1095                             hbuf, sizeof(hbuf), NULL, 0,
1096                             NI_NUMERICHOST | niflag) != 0)
1097                                 strlcpy(hbuf, "invalid", sizeof(hbuf));
1098                         Printf("packet too short (%d bytes) from %s\n", cc,
1099                             hbuf);
1100                 }
1101                 return (0);
1102         }
1103         cc -= hlen;
1104         icp = (struct icmp6_hdr *)(buf + hlen);
1105 #else
1106         if (cc < sizeof(struct icmp6_hdr)) {
1107                 if (verbose) {
1108                         if (getnameinfo((struct sockaddr *)from, from->sin6_len,
1109                             hbuf, sizeof(hbuf), NULL, 0,
1110                             NI_NUMERICHOST | niflag) != 0)
1111                                 strlcpy(hbuf, "invalid", sizeof(hbuf));
1112                         Printf("data too short (%d bytes) from %s\n", cc, hbuf);
1113                 }
1114                 return(0);
1115         }
1116         icp = (struct icmp6_hdr *)buf;
1117 #endif
1118         /* get optional information via advanced API */
1119         rcvpktinfo = NULL;
1120         hlimp = NULL;
1121         for (cm = (struct cmsghdr *)CMSG_FIRSTHDR(mhdr); cm;
1122              cm = (struct cmsghdr *)CMSG_NXTHDR(mhdr, cm)) {
1123                 if (cm->cmsg_level == IPPROTO_IPV6 &&
1124                     cm->cmsg_type == IPV6_PKTINFO &&
1125                     cm->cmsg_len ==
1126                     CMSG_LEN(sizeof(struct in6_pktinfo)))
1127                         rcvpktinfo = (struct in6_pktinfo *)(CMSG_DATA(cm));
1128
1129                 if (cm->cmsg_level == IPPROTO_IPV6 &&
1130                     cm->cmsg_type == IPV6_HOPLIMIT &&
1131                     cm->cmsg_len == CMSG_LEN(sizeof(int)))
1132                         hlimp = (int *)CMSG_DATA(cm);
1133         }
1134         if (rcvpktinfo == NULL || hlimp == NULL) {
1135                 warnx("failed to get received hop limit or packet info");
1136 #if 0
1137                 return(0);
1138 #else
1139                 rcvhlim = 0;    /*XXX*/
1140 #endif
1141         }
1142         else
1143                 rcvhlim = *hlimp;
1144
1145         type = icp->icmp6_type;
1146         code = icp->icmp6_code;
1147         if ((type == ICMP6_TIME_EXCEEDED && code == ICMP6_TIME_EXCEED_TRANSIT)
1148          || type == ICMP6_DST_UNREACH) {
1149                 struct ip6_hdr *hip;
1150                 struct udphdr *up;
1151
1152                 hip = (struct ip6_hdr *)(icp + 1);
1153                 if ((up = get_udphdr(hip, (u_char *)(buf + cc))) == NULL) {
1154                         if (verbose)
1155                                 warnx("failed to get upper layer header");
1156                         return(0);
1157                 }
1158                 if (up->uh_sport == htons(ident) &&
1159                     up->uh_dport == htons(port+seq))
1160                         return (type == ICMP6_TIME_EXCEEDED ? -1 : code + 1);
1161         }
1162         if (verbose) {
1163                 int i;
1164                 u_int8_t *p;
1165                 char sbuf[NI_MAXHOST+1], dbuf[INET6_ADDRSTRLEN];
1166
1167                 if (getnameinfo((struct sockaddr *)from, from->sin6_len,
1168                     sbuf, sizeof(sbuf), NULL, 0, NI_NUMERICHOST | niflag) != 0)
1169                         strlcpy(sbuf, "invalid", sizeof(hbuf));
1170                 Printf("\n%d bytes from %s to %s", cc, sbuf,
1171                     rcvpktinfo ? inet_ntop(AF_INET6, &rcvpktinfo->ipi6_addr,
1172                                         dbuf, sizeof(dbuf))
1173                                : "?");
1174                 Printf(": icmp type %d (%s) code %d\n", type, pr_type(type),
1175                        icp->icmp6_code);
1176                 p = (u_int8_t *)(icp + 1);
1177 #define WIDTH   16
1178                 for (i = 0; i < cc; i++) {
1179                         if (i % WIDTH == 0)
1180                                 Printf("%04x:", i);
1181                         if (i % 4 == 0)
1182                                 Printf(" ");
1183                         Printf("%02x", p[i]);
1184                         if (i % WIDTH == WIDTH - 1)
1185                                 Printf("\n");
1186                 }
1187                 if (cc % WIDTH != 0)
1188                         Printf("\n");
1189         }
1190         return(0);
1191 }
1192
1193 /*
1194  * Increment pointer until find the UDP header.
1195  */
1196 struct udphdr *
1197 get_udphdr(struct ip6_hdr *ip6, u_char *lim)
1198 {
1199         u_char *cp = (u_char *)ip6, nh;
1200         int hlen;
1201
1202         if (cp + sizeof(*ip6) >= lim)
1203                 return(NULL);
1204
1205         nh = ip6->ip6_nxt;
1206         cp += sizeof(struct ip6_hdr);
1207
1208         while(lim - cp >= 8) {
1209                 switch(nh) {
1210                  case IPPROTO_ESP:
1211                  case IPPROTO_TCP:
1212                  case IPPROTO_ICMPV6:
1213                          return(NULL);
1214                  case IPPROTO_UDP:
1215                          return((struct udphdr *)cp);
1216                  case IPPROTO_FRAGMENT:
1217                          hlen = sizeof(struct ip6_frag);
1218                          nh = ((struct ip6_frag *)cp)->ip6f_nxt;
1219                          break;
1220                  case IPPROTO_AH:
1221                          hlen = (((struct ip6_ext *)cp)->ip6e_len + 2) << 2;
1222                          nh = ((struct ip6_ext *)cp)->ip6e_nxt;
1223                          break;
1224                   default:
1225                           hlen = (((struct ip6_ext *)cp)->ip6e_len + 1) << 3;
1226                           nh = ((struct ip6_ext *)cp)->ip6e_nxt;
1227                           break;
1228                 }
1229
1230                 cp += hlen;
1231         }
1232
1233         return(NULL);
1234 }
1235
1236 void
1237 print(struct msghdr *mhdr, int cc)
1238 {
1239         struct sockaddr_in6 *from = (struct sockaddr_in6 *)mhdr->msg_name;
1240         char hbuf[NI_MAXHOST];
1241
1242         if (getnameinfo((struct sockaddr *)from, from->sin6_len,
1243             hbuf, sizeof(hbuf), NULL, 0, NI_NUMERICHOST | niflag) != 0)
1244                 strlcpy(hbuf, "invalid", sizeof(hbuf));
1245         if (nflag)
1246                 Printf(" %s", hbuf);
1247         else if (lflag)
1248                 Printf(" %s (%s)", inetname((struct sockaddr *)from), hbuf);
1249         else
1250                 Printf(" %s", inetname((struct sockaddr *)from));
1251
1252         if (verbose) {
1253 #ifdef OLDRAWSOCKET
1254                 Printf(" %d bytes to %s", cc,
1255                     rcvpktinfo ? inet_ntop(AF_INET6, &rcvpktinfo->ipi6_addr,
1256                                         hbuf, sizeof(hbuf))
1257                                : "?");
1258 #else
1259                 Printf(" %d bytes of data to %s", cc,
1260                     rcvpktinfo ?  inet_ntop(AF_INET6, &rcvpktinfo->ipi6_addr,
1261                                         hbuf, sizeof(hbuf))
1262                                : "?");
1263 #endif
1264         }
1265 }
1266
1267 /*
1268  * Subtract 2 timeval structs:  out = out - in.
1269  * Out is assumed to be >= in.
1270  */
1271 void
1272 tvsub(struct timeval *out, struct timeval *in)
1273 {
1274         if ((out->tv_usec -= in->tv_usec) < 0)   {
1275                 out->tv_sec--;
1276                 out->tv_usec += 1000000;
1277         }
1278         out->tv_sec -= in->tv_sec;
1279 }
1280
1281
1282 /*
1283  * Construct an Internet address representation.
1284  * If the nflag has been supplied, give
1285  * numeric value, otherwise try for symbolic name.
1286  */
1287 const char *
1288 inetname(struct sockaddr *sa)
1289 {
1290         char *cp;
1291         static char line[NI_MAXHOST];
1292         static char domain[MAXHOSTNAMELEN + 1];
1293         static int first = 1;
1294
1295         if (first && !nflag) {
1296                 first = 0;
1297                 if (gethostname(domain, MAXHOSTNAMELEN) == 0 &&
1298                     (cp = strchr(domain, '.')))
1299                         (void) strlcpy(domain, cp + 1, sizeof(domain));
1300                 else
1301                         domain[0] = 0;
1302         }
1303         cp = NULL;
1304         if (!nflag) {
1305                 if (getnameinfo(sa, sa->sa_len, line, sizeof(line), NULL, 0,
1306                     NI_NAMEREQD) == 0) {
1307                         if ((cp = strchr(line, '.')) &&
1308                             !strcmp(cp + 1, domain))
1309                                 *cp = 0;
1310                         cp = line;
1311                 }
1312         }
1313         if (cp)
1314                 return cp;
1315
1316         if (getnameinfo(sa, sa->sa_len, line, sizeof(line), NULL, 0,
1317             NI_NUMERICHOST | niflag) != 0)
1318                 strlcpy(line, "invalid", sizeof(line));
1319         return line;
1320 }
1321
1322 void
1323 usage(void)
1324 {
1325         (void)fprintf(stderr,
1326 "usage: traceroute6 [-dlnrv] [-f firsthop] [-g gateway] [-m hoplimit] [-p port]\n"
1327 "       [-q probes] [-s src] [-w waittime] target [datalen]\n");
1328         exit(1);
1329 }