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.6 2004/12/18 22:48:14 swildner 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 fprintf
 292 #define Sprintf sprintf
 293 #define Printf 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                 fprintf(stderr, "traceroute6: %s\n", gai_strerror(error));
 570                 exit(1);
 571         }
 572         if (res->ai_addrlen != sizeof(Dst)) {
 573                 fprintf(stderr, "traceroute6: size of sockaddr mismatch\n");
 574                 exit(1);
 575         }
 576         memcpy(&Dst, res->ai_addr, res->ai_addrlen);
 577         hostname = res->ai_canonname ? strdup(res->ai_canonname) : *argv;
 578         if (!hostname) {
 579                 fprintf(stderr, "traceroute6: not enough core\n");
 580                 exit(1);
 581         }
 582
 583         if (*++argv) {
 584                 ep = NULL;
 585                 datalen = strtoul(*argv, &ep, 0);
 586                 if (!*argv || *ep) {
 587                         Fprintf(stderr,
 588                             "traceroute6: invalid packet length.\n");
 589                         exit(1);
 590                 }
 591         }
 592         if (datalen < 0 || datalen >= MAXPACKET - sizeof(struct opacket)) {
 593                 Fprintf(stderr,
 594                     "traceroute6: packet size must be 0 <= s < %ld.\n",
 595                     (long)(MAXPACKET - sizeof(struct opacket)));
 596                 exit(1);
 597         }
 598         datalen += sizeof(struct opacket);
 599         outpacket = (struct opacket *)malloc((unsigned)datalen);
 600         if (! outpacket) {
 601                 perror("malloc");
 602                 exit(1);
 603         }
 604         bzero((char *)outpacket, datalen);
 605
 606         /* initialize msghdr for receiving packets */
 607         rcviov[0].iov_base = (caddr_t)packet;
 608         rcviov[0].iov_len = sizeof(packet);
 609         rcvmhdr.msg_name = (caddr_t)&Rcv;
 610         rcvmhdr.msg_namelen = sizeof(Rcv);
 611         rcvmhdr.msg_iov = rcviov;
 612         rcvmhdr.msg_iovlen = 1;
 613         rcvcmsglen = CMSG_SPACE(sizeof(struct in6_pktinfo))
 614                 + CMSG_SPACE(sizeof(int));
 615         if ((rcvcmsgbuf = malloc(rcvcmsglen)) == NULL) {
 616                 Fprintf(stderr, "traceroute6: malloc failed\n");
 617                 exit(1);
 618         }
 619         rcvmhdr.msg_control = (caddr_t) rcvcmsgbuf;
 620         rcvmhdr.msg_controllen = rcvcmsglen;
 621
 622         if (options & SO_DEBUG)
 623                 setsockopt(rcvsock, SOL_SOCKET, SO_DEBUG,
 624                            (char *)&on, sizeof(on));
 625         if (options & SO_DONTROUTE)
 626                 setsockopt(rcvsock, SOL_SOCKET, SO_DONTROUTE,
 627                            (char *)&on, sizeof(on));
 628 #ifdef IPSEC
 629 #ifdef IPSEC_POLICY_IPSEC
 630         /*
 631          * do not raise error even if setsockopt fails, kernel may have ipsec
 632          * turned off.
 633          */
 634         if (setpolicy(rcvsock, "in bypass") < 0)
 635                 errx(1, "%s", ipsec_strerror());
 636         if (setpolicy(rcvsock, "out bypass") < 0)
 637                 errx(1, "%s", ipsec_strerror());
 638 #else
 639     {
 640         int level = IPSEC_LEVEL_NONE;
 641
 642         setsockopt(rcvsock, IPPROTO_IPV6, IPV6_ESP_TRANS_LEVEL, &level,
 643                    sizeof(level));
 644         setsockopt(rcvsock, IPPROTO_IPV6, IPV6_ESP_NETWORK_LEVEL, &level,
 645                    sizeof(level));
 646 #ifdef IP_AUTH_TRANS_LEVEL
 647         setsockopt(rcvsock, IPPROTO_IPV6, IPV6_AUTH_TRANS_LEVEL, &level,
 648                 sizeof(level));
 649 #else
 650         setsockopt(rcvsock, IPPROTO_IPV6, IPV6_AUTH_LEVEL, &level,
 651                    sizeof(level));
 652 #endif
 653 #ifdef IP_AUTH_NETWORK_LEVEL
 654         setsockopt(rcvsock, IPPROTO_IPV6, IPV6_AUTH_NETWORK_LEVEL, &level,
 655                    sizeof(level));
 656 #endif
 657     }
 658 #endif /*IPSEC_POLICY_IPSEC*/
 659 #endif /*IPSEC*/
 660
 661         /*
 662          * Send UDP
 663          */
 664         if ((sndsock = socket(AF_INET6, SOCK_DGRAM, 0)) < 0) {
 665                 perror("socket(SOCK_DGRAM)");
 666                 exit(5);
 667         }
 668 #ifdef SO_SNDBUF
 669         if (setsockopt(sndsock, SOL_SOCKET, SO_SNDBUF, (char *)&datalen,
 670                        sizeof(datalen)) < 0) {
 671                 perror("setsockopt(SO_SNDBUF)");
 672                 exit(6);
 673         }
 674 #endif /* SO_SNDBUF */
 675         if (options & SO_DEBUG)
 676                 setsockopt(sndsock, SOL_SOCKET, SO_DEBUG,
 677                            (char *)&on, sizeof(on));
 678         if (options & SO_DONTROUTE)
 679                 setsockopt(sndsock, SOL_SOCKET, SO_DONTROUTE,
 680                            (char *)&on, sizeof(on));
 681 #ifdef USE_RFC2292BIS
 682         if (rth) {/* XXX: there is no library to finalize the header... */
 683                 rth->ip6r_len = rth->ip6r_segleft * 2;
 684                 if (setsockopt(sndsock, IPPROTO_IPV6, IPV6_RTHDR,
 685                                (void *)rth, (rth->ip6r_len + 1) << 3)) {
 686                         Fprintf(stderr, "setsockopt(IPV6_RTHDR): %s\n",
 687                                 strerror(errno));
 688                         exit(1);
 689                 }
 690         }
 691 #else  /* old advanced API */
 692         if (cmsg != NULL) {
 693                 inet6_rthdr_lasthop(cmsg, IPV6_RTHDR_LOOSE);
 694                 if (setsockopt(sndsock, IPPROTO_IPV6, IPV6_PKTOPTIONS,
 695                                rtbuf, cmsg->cmsg_len) < 0) {
 696                         Fprintf(stderr, "setsockopt(IPV6_PKTOPTIONS): %s\n",
 697                                 strerror(errno));
 698                         exit(1);
 699                 }
 700         }
 701 #endif /* USE_RFC2292BIS */
 702 #ifdef IPSEC
 703 #ifdef IPSEC_POLICY_IPSEC
 704         /*
 705          * do not raise error even if setsockopt fails, kernel may have ipsec
 706          * turned off.
 707          */
 708         if (setpolicy(sndsock, "in bypass") < 0)
 709                 errx(1, "%s", ipsec_strerror());
 710         if (setpolicy(sndsock, "out bypass") < 0)
 711                 errx(1, "%s", ipsec_strerror());
 712 #else
 713     {
 714         int level = IPSEC_LEVEL_BYPASS;
 715
 716         setsockopt(sndsock, IPPROTO_IPV6, IPV6_ESP_TRANS_LEVEL, &level,
 717                    sizeof(level));
 718         setsockopt(sndsock, IPPROTO_IPV6, IPV6_ESP_NETWORK_LEVEL, &level,
 719                    sizeof(level));
 720 #ifdef IP_AUTH_TRANS_LEVEL
 721         setsockopt(sndsock, IPPROTO_IPV6, IPV6_AUTH_TRANS_LEVEL, &level,
 722                    sizeof(level));
 723 #else
 724         setsockopt(sndsock, IPPROTO_IPV6, IPV6_AUTH_LEVEL, &level,
 725                    sizeof(level));
 726 #endif
 727 #ifdef IP_AUTH_NETWORK_LEVEL
 728         setsockopt(sndsock, IPPROTO_IPV6, IPV6_AUTH_NETWORK_LEVEL, &level,
 729                    sizeof(level));
 730 #endif
 731     }
 732 #endif /*IPSEC_POLICY_IPSEC*/
 733 #endif /*IPSEC*/
 734
 735         /*
 736          * Source selection
 737          */
 738         bzero(&Src, sizeof(Src));
 739         if (source) {
 740                 struct addrinfo hints, *res;
 741                 int error;
 742
 743                 memset(&hints, 0, sizeof(hints));
 744                 hints.ai_family = AF_INET6;
 745                 hints.ai_socktype = SOCK_DGRAM; /*dummy*/
 746                 hints.ai_flags = AI_NUMERICHOST;
 747                 error = getaddrinfo(source, "0", &hints, &res);
 748                 if (error) {
 749                         Printf("traceroute6: %s: %s\n", source,
 750                             gai_strerror(error));
 751                         exit(1);
 752                 }
 753                 if (res->ai_addrlen > sizeof(Src)) {
 754                         Printf("traceroute6: %s: %s\n", source,
 755                             gai_strerror(error));
 756                         exit(1);
 757                 }
 758                 memcpy(&Src, res->ai_addr, res->ai_addrlen);
 759                 freeaddrinfo(res);
 760         } else {
 761                 struct sockaddr_in6 Nxt;
 762                 int dummy, len;
 763
 764                 Nxt = Dst;
 765                 Nxt.sin6_port = htons(DUMMY_PORT);
 766                 if (cmsg != NULL)
 767                         bcopy(inet6_rthdr_getaddr(cmsg, 1), &Nxt.sin6_addr,
 768                               sizeof(Nxt.sin6_addr));
 769                 if ((dummy = socket(AF_INET6, SOCK_DGRAM, 0)) < 0) {
 770                         perror("socket");
 771                         exit(1);
 772                 }
 773                 if (connect(dummy, (struct sockaddr *)&Nxt, Nxt.sin6_len) < 0) {
 774                         perror("connect");
 775                         exit(1);
 776                 }
 777                 len = sizeof(Src);
 778                 if (getsockname(dummy, (struct sockaddr *)&Src, &len) < 0) {
 779                         perror("getsockname");
 780                         exit(1);
 781                 }
 782                 if (getnameinfo((struct sockaddr *)&Src, Src.sin6_len,
 783                                 src0, sizeof(src0), NULL, 0,
 784                                 NI_NUMERICHOST | niflag)) {
 785                         Fprintf(stderr, "getnameinfo failed for source\n");
 786                         exit(1);
 787                 }
 788                 source = src0;
 789                 close(dummy);
 790         }
 791
 792 #if 1
 793         ident = (getpid() & 0xffff) | 0x8000;
 794 #else
 795         ident = 0;      /*let the kernel pick one*/
 796 #endif
 797         Src.sin6_port = htons(ident);
 798         if (bind(sndsock, (struct sockaddr *)&Src, Src.sin6_len) < 0) {
 799                 perror("bind");
 800                 exit(1);
 801         }
 802
 803         if (ident == 0) {
 804                 int len;
 805
 806                 len = sizeof(Src);
 807                 if (getsockname(sndsock, (struct sockaddr *)&Src, &i) < 0) {
 808                         perror("getsockname");
 809                         exit(1);
 810                 }
 811                 ident = ntohs(Src.sin6_port);
 812         }
 813
 814         /*
 815          * Message to users
 816          */
 817         if (getnameinfo((struct sockaddr *)&Dst, Dst.sin6_len, hbuf,
 818                         sizeof(hbuf), NULL, 0, NI_NUMERICHOST | niflag))
 819                 strlcpy(hbuf, "(invalid)", sizeof(hbuf));
 820         Fprintf(stderr, "traceroute6");
 821         Fprintf(stderr, " to %s (%s)", hostname, hbuf);
 822         if (source)
 823                 Fprintf(stderr, " from %s", source);
 824         Fprintf(stderr,
 825                 ", %d hops max, %d byte packets\n",
 826                 max_hops, datalen);
 827         fflush(stderr);
 828
 829         if (first_hop > 1)
 830                 Printf("Skipping %d intermediate hops\n", first_hop - 1);
 831
 832         /*
 833          * Main loop
 834          */
 835         for (hops = first_hop; hops <= max_hops; ++hops) {
 836                 struct in6_addr lastaddr;
 837                 int got_there = 0;
 838                 int unreachable = 0;
 839
 840                 Printf("%2d ", hops);
 841                 bzero(&lastaddr, sizeof(lastaddr));
 842                 for (probe = 0; probe < nprobes; ++probe) {
 843                         int cc;
 844                         struct timeval t1, t2;
 845                         struct timezone tz;
 846
 847                         gettimeofday(&t1, &tz);
 848                         send_probe(++seq, hops);
 849                         while ((cc = wait_for_reply(rcvsock, &rcvmhdr))) {
 850                                 gettimeofday(&t2, &tz);
 851                                 if ((i = packet_ok(&rcvmhdr, cc, seq))) {
 852                                         if (! IN6_ARE_ADDR_EQUAL(&Rcv.sin6_addr,
 853                                                             &lastaddr)) {
 854                                                 print(&rcvmhdr, cc);
 855                                                 lastaddr = Rcv.sin6_addr;
 856                                         }
 857                                         Printf("  %g ms", deltaT(&t1, &t2));
 858                                         switch(i - 1) {
 859                                         case ICMP6_DST_UNREACH_NOROUTE:
 860                                                 ++unreachable;
 861                                                 Printf(" !N");
 862                                                 break;
 863                                         case ICMP6_DST_UNREACH_ADMIN:
 864                                                 ++unreachable;
 865                                                 Printf(" !P");
 866                                                 break;
 867                                         case ICMP6_DST_UNREACH_NOTNEIGHBOR:
 868                                                 ++unreachable;
 869                                                 Printf(" !S");
 870                                                 break;
 871                                         case ICMP6_DST_UNREACH_ADDR:
 872                                                 ++unreachable;
 873                                                 Printf(" !A");
 874                                                 break;
 875                                         case ICMP6_DST_UNREACH_NOPORT:
 876                                                 if (rcvhlim >= 0 &&
 877                                                     rcvhlim <= 1)
 878                                                         Printf(" !");
 879                                                 ++got_there;
 880                                                 break;
 881                                         }
 882                                         break;
 883                                 }
 884                         }
 885                         if (cc == 0)
 886                                 Printf(" *");
 887                         fflush(stdout);
 888                 }
 889                 putchar('\n');
 890                 if (got_there ||
 891                     (unreachable > 0 && unreachable >= ((nprobes + 1) / 2))) {
 892                         exit(0);
 893                 }
 894         }
 895
 896         exit(0);
 897 }
 898
 899 int
 900 wait_for_reply(int sock, struct msghdr *mhdr)
 901 {
 902 #ifdef HAVE_POLL
 903         struct pollfd pfd[1];
 904         int cc = 0;
 905
 906         pfd[0].fd = sock;
 907         pfd[0].events = POLLIN;
 908         pfd[0].revents = 0;
 909
 910         if (poll(pfd, 1, waittime * 1000) > 0)
 911                 cc = recvmsg(rcvsock, mhdr, 0);
 912
 913         return(cc);
 914 #else
 915         fd_set *fdsp;
 916         struct timeval wait;
 917         int cc = 0, fdsn;
 918
 919         fdsn = howmany(sock + 1, NFDBITS) * sizeof(fd_mask);
 920         if ((fdsp = (fd_set *)malloc(fdsn)) == NULL)
 921                 err(1, "malloc");
 922         memset(fdsp, 0, fdsn);
 923         FD_SET(sock, fdsp);
 924         wait.tv_sec = waittime; wait.tv_usec = 0;
 925
 926         if (select(sock+1, fdsp, (fd_set *)0, (fd_set *)0, &wait) > 0)
 927                 cc = recvmsg(rcvsock, mhdr, 0);
 928
 929         free(fdsp);
 930         return(cc);
 931 #endif
 932 }
 933
 934 #ifdef IPSEC
 935 #ifdef IPSEC_POLICY_IPSEC
 936 int
 937 setpolicy(int so, char *policy)
 938 {
 939         char *buf;
 940
 941         buf = ipsec_set_policy(policy, strlen(policy));
 942         if (buf == NULL) {
 943                 warnx("%s", ipsec_strerror());
 944                 return -1;
 945         }
 946         setsockopt(so, IPPROTO_IPV6, IPV6_IPSEC_POLICY,
 947                    buf, ipsec_get_policylen(buf));
 948
 949         free(buf);
 950
 951         return 0;
 952 }
 953 #endif
 954 #endif
 955
 956 void
 957 send_probe(int seq, int hops)
 958 {
 959         struct opacket *op = outpacket;
 960         int i;
 961
 962         if(setsockopt(sndsock, IPPROTO_IPV6, IPV6_UNICAST_HOPS,
 963                       (char *)&hops, sizeof(hops)) < 0) {
 964                 perror("setsockopt IPV6_UNICAST_HOPS");
 965         }
 966
 967         Dst.sin6_port = htons(port + seq);
 968
 969         op->seq = seq;
 970         op->hops = hops;
 971         gettimeofday(&op->tv, &tz);
 972
 973         i = sendto(sndsock, (char *)outpacket, datalen , 0,
 974                    (struct sockaddr *)&Dst, Dst.sin6_len);
 975         if (i < 0 || i != datalen)  {
 976                 if (i<0)
 977                         perror("sendto");
 978                 Printf("traceroute6: wrote %s %d chars, ret=%d\n", hostname,
 979                        datalen, i);
 980                 fflush(stdout);
 981         }
 982 }
 983
 984 int
 985 get_hoplim(struct msghdr *mhdr)
 986 {
 987         struct cmsghdr *cm;
 988
 989         for (cm = (struct cmsghdr *)CMSG_FIRSTHDR(mhdr); cm;
 990              cm = (struct cmsghdr *)CMSG_NXTHDR(mhdr, cm)) {
 991                 if (cm->cmsg_level == IPPROTO_IPV6 &&
 992                     cm->cmsg_type == IPV6_HOPLIMIT &&
 993                     cm->cmsg_len == CMSG_LEN(sizeof(int)))
 994                         return(*(int *)CMSG_DATA(cm));
 995         }
 996
 997         return(-1);
 998 }
 999
1000 double
1001 deltaT(struct timeval *t1p, struct timeval *t2p)
1002 {
1003         double dt;
1004
1005         dt = (double)(t2p->tv_sec - t1p->tv_sec) * 1000.0 +
1006              (double)(t2p->tv_usec - t1p->tv_usec) / 1000.0;
1007         return (dt);
1008 }
1009
1010
1011 /*
1012  * Convert an ICMP "type" field to a printable string.
1013  */
1014 char *
1015 pr_type(int t0)
1016 {
1017         u_char t = t0 & 0xff;
1018         char *cp;
1019
1020         switch (t) {
1021         case ICMP6_DST_UNREACH:
1022                 cp = "Destination Unreachable";
1023                 break;
1024         case ICMP6_PACKET_TOO_BIG:
1025                 cp = "Pakcet Too Big";
1026                 break;
1027         case ICMP6_TIME_EXCEEDED:
1028                 cp = "Time Exceeded";
1029                 break;
1030         case ICMP6_PARAM_PROB:
1031                 cp = "Parameter Problem";
1032                 break;
1033         case ICMP6_ECHO_REQUEST:
1034                 cp = "Echo Request";
1035                 break;
1036         case ICMP6_ECHO_REPLY:
1037                 cp = "Echo Reply";
1038                 break;
1039         case ICMP6_MEMBERSHIP_QUERY:
1040                 cp = "Group Membership Query";
1041                 break;
1042         case ICMP6_MEMBERSHIP_REPORT:
1043                 cp = "Group Membership Report";
1044                 break;
1045         case ICMP6_MEMBERSHIP_REDUCTION:
1046                 cp = "Group Membership Reduction";
1047                 break;
1048         case ND_ROUTER_SOLICIT:
1049                 cp = "Router Solicitation";
1050                 break;
1051         case ND_ROUTER_ADVERT:
1052                 cp = "Router Advertisement";
1053                 break;
1054         case ND_NEIGHBOR_SOLICIT:
1055                 cp = "Neighbor Solicitation";
1056                 break;
1057         case ND_NEIGHBOR_ADVERT:
1058                 cp = "Neighbor Advertisement";
1059                 break;
1060         case ND_REDIRECT:
1061                 cp = "Redirect";
1062                 break;
1063         default:
1064                 cp = "Unknown";
1065                 break;
1066         }
1067         return cp;
1068 }
1069
1070
1071 int
1072 packet_ok(struct msghdr *mhdr, int cc, int seq)
1073 {
1074         struct icmp6_hdr *icp;
1075         struct sockaddr_in6 *from = (struct sockaddr_in6 *)mhdr->msg_name;
1076         u_char type, code;
1077         char *buf = (char *)mhdr->msg_iov[0].iov_base;
1078         struct cmsghdr *cm;
1079         int *hlimp;
1080         char hbuf[NI_MAXHOST];
1081
1082 #ifdef OLDRAWSOCKET
1083         int hlen;
1084         struct ip6_hdr *ip;
1085 #endif
1086
1087 #ifdef OLDRAWSOCKET
1088         ip = (struct ip6_hdr *) buf;
1089         hlen = sizeof(struct ip6_hdr);
1090         if (cc < hlen + sizeof(struct icmp6_hdr)) {
1091                 if (verbose) {
1092                         if (getnameinfo((struct sockaddr *)from, from->sin6_len,
1093                             hbuf, sizeof(hbuf), NULL, 0,
1094                             NI_NUMERICHOST | niflag) != 0)
1095                                 strlcpy(hbuf, "invalid", sizeof(hbuf));
1096                         Printf("packet too short (%d bytes) from %s\n", cc,
1097                             hbuf);
1098                 }
1099                 return (0);
1100         }
1101         cc -= hlen;
1102         icp = (struct icmp6_hdr *)(buf + hlen);
1103 #else
1104         if (cc < sizeof(struct icmp6_hdr)) {
1105                 if (verbose) {
1106                         if (getnameinfo((struct sockaddr *)from, from->sin6_len,
1107                             hbuf, sizeof(hbuf), NULL, 0,
1108                             NI_NUMERICHOST | niflag) != 0)
1109                                 strlcpy(hbuf, "invalid", sizeof(hbuf));
1110                         Printf("data too short (%d bytes) from %s\n", cc, hbuf);
1111                 }
1112                 return(0);
1113         }
1114         icp = (struct icmp6_hdr *)buf;
1115 #endif
1116         /* get optional information via advanced API */
1117         rcvpktinfo = NULL;
1118         hlimp = NULL;
1119         for (cm = (struct cmsghdr *)CMSG_FIRSTHDR(mhdr); cm;
1120              cm = (struct cmsghdr *)CMSG_NXTHDR(mhdr, cm)) {
1121                 if (cm->cmsg_level == IPPROTO_IPV6 &&
1122                     cm->cmsg_type == IPV6_PKTINFO &&
1123                     cm->cmsg_len ==
1124                     CMSG_LEN(sizeof(struct in6_pktinfo)))
1125                         rcvpktinfo = (struct in6_pktinfo *)(CMSG_DATA(cm));
1126
1127                 if (cm->cmsg_level == IPPROTO_IPV6 &&
1128                     cm->cmsg_type == IPV6_HOPLIMIT &&
1129                     cm->cmsg_len == CMSG_LEN(sizeof(int)))
1130                         hlimp = (int *)CMSG_DATA(cm);
1131         }
1132         if (rcvpktinfo == NULL || hlimp == NULL) {
1133                 warnx("failed to get received hop limit or packet info");
1134 #if 0
1135                 return(0);
1136 #else
1137                 rcvhlim = 0;    /*XXX*/
1138 #endif
1139         }
1140         else
1141                 rcvhlim = *hlimp;
1142
1143         type = icp->icmp6_type;
1144         code = icp->icmp6_code;
1145         if ((type == ICMP6_TIME_EXCEEDED && code == ICMP6_TIME_EXCEED_TRANSIT)
1146          || type == ICMP6_DST_UNREACH) {
1147                 struct ip6_hdr *hip;
1148                 struct udphdr *up;
1149
1150                 hip = (struct ip6_hdr *)(icp + 1);
1151                 if ((up = get_udphdr(hip, (u_char *)(buf + cc))) == NULL) {
1152                         if (verbose)
1153                                 warnx("failed to get upper layer header");
1154                         return(0);
1155                 }
1156                 if (up->uh_sport == htons(ident) &&
1157                     up->uh_dport == htons(port+seq))
1158                         return (type == ICMP6_TIME_EXCEEDED ? -1 : code + 1);
1159         }
1160         if (verbose) {
1161                 int i;
1162                 u_int8_t *p;
1163                 char sbuf[NI_MAXHOST+1], dbuf[INET6_ADDRSTRLEN];
1164
1165                 if (getnameinfo((struct sockaddr *)from, from->sin6_len,
1166                     sbuf, sizeof(sbuf), NULL, 0, NI_NUMERICHOST | niflag) != 0)
1167                         strlcpy(sbuf, "invalid", sizeof(hbuf));
1168                 Printf("\n%d bytes from %s to %s", cc, sbuf,
1169                     rcvpktinfo ? inet_ntop(AF_INET6, &rcvpktinfo->ipi6_addr,
1170                                         dbuf, sizeof(dbuf))
1171                                : "?");
1172                 Printf(": icmp type %d (%s) code %d\n", type, pr_type(type),
1173                        icp->icmp6_code);
1174                 p = (u_int8_t *)(icp + 1);
1175 #define WIDTH   16
1176                 for (i = 0; i < cc; i++) {
1177                         if (i % WIDTH == 0)
1178                                 Printf("%04x:", i);
1179                         if (i % 4 == 0)
1180                                 Printf(" ");
1181                         Printf("%02x", p[i]);
1182                         if (i % WIDTH == WIDTH - 1)
1183                                 Printf("\n");
1184                 }
1185                 if (cc % WIDTH != 0)
1186                         Printf("\n");
1187         }
1188         return(0);
1189 }
1190
1191 /*
1192  * Increment pointer until find the UDP header.
1193  */
1194 struct udphdr *
1195 get_udphdr(struct ip6_hdr *ip6, u_char *lim)
1196 {
1197         u_char *cp = (u_char *)ip6, nh;
1198         int hlen;
1199
1200         if (cp + sizeof(*ip6) >= lim)
1201                 return(NULL);
1202
1203         nh = ip6->ip6_nxt;
1204         cp += sizeof(struct ip6_hdr);
1205
1206         while(lim - cp >= 8) {
1207                 switch(nh) {
1208                  case IPPROTO_ESP:
1209                  case IPPROTO_TCP:
1210                  case IPPROTO_ICMPV6:
1211                          return(NULL);
1212                  case IPPROTO_UDP:
1213                          return((struct udphdr *)cp);
1214                  case IPPROTO_FRAGMENT:
1215                          hlen = sizeof(struct ip6_frag);
1216                          nh = ((struct ip6_frag *)cp)->ip6f_nxt;
1217                          break;
1218                  case IPPROTO_AH:
1219                          hlen = (((struct ip6_ext *)cp)->ip6e_len + 2) << 2;
1220                          nh = ((struct ip6_ext *)cp)->ip6e_nxt;
1221                          break;
1222                   default:
1223                           hlen = (((struct ip6_ext *)cp)->ip6e_len + 1) << 3;
1224                           nh = ((struct ip6_ext *)cp)->ip6e_nxt;
1225                           break;
1226                 }
1227
1228                 cp += hlen;
1229         }
1230
1231         return(NULL);
1232 }
1233
1234 void
1235 print(struct msghdr *mhdr, int cc)
1236 {
1237         struct sockaddr_in6 *from = (struct sockaddr_in6 *)mhdr->msg_name;
1238         char hbuf[NI_MAXHOST];
1239
1240         if (getnameinfo((struct sockaddr *)from, from->sin6_len,
1241             hbuf, sizeof(hbuf), NULL, 0, NI_NUMERICHOST | niflag) != 0)
1242                 strlcpy(hbuf, "invalid", sizeof(hbuf));
1243         if (nflag)
1244                 Printf(" %s", hbuf);
1245         else if (lflag)
1246                 Printf(" %s (%s)", inetname((struct sockaddr *)from), hbuf);
1247         else
1248                 Printf(" %s", inetname((struct sockaddr *)from));
1249
1250         if (verbose) {
1251 #ifdef OLDRAWSOCKET
1252                 Printf(" %d bytes to %s", cc,
1253                     rcvpktinfo ? inet_ntop(AF_INET6, &rcvpktinfo->ipi6_addr,
1254                                         hbuf, sizeof(hbuf))
1255                                : "?");
1256 #else
1257                 Printf(" %d bytes of data to %s", cc,
1258                     rcvpktinfo ?  inet_ntop(AF_INET6, &rcvpktinfo->ipi6_addr,
1259                                         hbuf, sizeof(hbuf))
1260                                : "?");
1261 #endif
1262         }
1263 }
1264
1265 /*
1266  * Subtract 2 timeval structs:  out = out - in.
1267  * Out is assumed to be >= in.
1268  */
1269 void
1270 tvsub(struct timeval *out, struct timeval *in)
1271 {
1272         if ((out->tv_usec -= in->tv_usec) < 0)   {
1273                 out->tv_sec--;
1274                 out->tv_usec += 1000000;
1275         }
1276         out->tv_sec -= in->tv_sec;
1277 }
1278
1279
1280 /*
1281  * Construct an Internet address representation.
1282  * If the nflag has been supplied, give
1283  * numeric value, otherwise try for symbolic name.
1284  */
1285 const char *
1286 inetname(struct sockaddr *sa)
1287 {
1288         char *cp;
1289         static char line[NI_MAXHOST];
1290         static char domain[MAXHOSTNAMELEN + 1];
1291         static int first = 1;
1292
1293         if (first && !nflag) {
1294                 first = 0;
1295                 if (gethostname(domain, MAXHOSTNAMELEN) == 0 &&
1296                     (cp = strchr(domain, '.')))
1297                         strlcpy(domain, cp + 1, sizeof(domain));
1298                 else
1299                         domain[0] = 0;
1300         }
1301         cp = NULL;
1302         if (!nflag) {
1303                 if (getnameinfo(sa, sa->sa_len, line, sizeof(line), NULL, 0,
1304                     NI_NAMEREQD) == 0) {
1305                         if ((cp = strchr(line, '.')) &&
1306                             !strcmp(cp + 1, domain))
1307                                 *cp = 0;
1308                         cp = line;
1309                 }
1310         }
1311         if (cp)
1312                 return cp;
1313
1314         if (getnameinfo(sa, sa->sa_len, line, sizeof(line), NULL, 0,
1315             NI_NUMERICHOST | niflag) != 0)
1316                 strlcpy(line, "invalid", sizeof(line));
1317         return line;
1318 }
1319
1320 void
1321 usage(void)
1322 {
1323         fprintf(stderr,
1324 "usage: traceroute6 [-dlnrv] [-f firsthop] [-g gateway] [-m hoplimit] [-p port]\n"
1325 "       [-q probes] [-s src] [-w waittime] target [datalen]\n");
1326         exit(1);
1327 }