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