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