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