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.4 2004/03/30 01:14:22 cpressey 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 = index(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 = index(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 }