1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256#define TRACEROUTE_SO_DEBUG 0
257
258
259
260
261
262
263
264
265
266
267
268#include <net/if.h>
269#include <arpa/inet.h>
270#include <netinet/in.h>
271#include <netinet/udp.h>
272#include <netinet/ip.h>
273#include <netinet/ip_icmp.h>
274#if ENABLE_FEATURE_IPV6
275# include <netinet/ip6.h>
276# include <netinet/icmp6.h>
277# ifndef SOL_IPV6
278# define SOL_IPV6 IPPROTO_IPV6
279# endif
280#endif
281
282#include "libbb.h"
283#include "inet_common.h"
284
285#ifndef IPPROTO_ICMP
286# define IPPROTO_ICMP 1
287#endif
288#ifndef IPPROTO_IP
289# define IPPROTO_IP 0
290#endif
291
292
293#define OPT_STRING \
294 "FIlnrdvxt:i:m:p:q:s:w:z:f:" \
295 IF_FEATURE_TRACEROUTE_SOURCE_ROUTE("g:") \
296 "4" IF_TRACEROUTE6("6")
297enum {
298 OPT_DONT_FRAGMNT = (1 << 0),
299 OPT_USE_ICMP = (1 << 1) * ENABLE_FEATURE_TRACEROUTE_USE_ICMP,
300 OPT_TTL_FLAG = (1 << 2),
301 OPT_ADDR_NUM = (1 << 3),
302 OPT_BYPASS_ROUTE = (1 << 4),
303 OPT_DEBUG = (1 << 5),
304 OPT_VERBOSE = (1 << 6) * ENABLE_FEATURE_TRACEROUTE_VERBOSE,
305 OPT_IP_CHKSUM = (1 << 7),
306 OPT_TOS = (1 << 8),
307 OPT_DEVICE = (1 << 9),
308 OPT_MAX_TTL = (1 << 10),
309 OPT_PORT = (1 << 11),
310 OPT_NPROBES = (1 << 12),
311 OPT_SOURCE = (1 << 13),
312 OPT_WAITTIME = (1 << 14),
313 OPT_PAUSE_MS = (1 << 15),
314 OPT_FIRST_TTL = (1 << 16),
315 OPT_SOURCE_ROUTE = (1 << 17) * ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE,
316 OPT_IPV4 = (1 << (17+ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE)),
317 OPT_IPV6 = (1 << (18+ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE)) * ENABLE_TRACEROUTE6,
318};
319#define verbose (option_mask32 & OPT_VERBOSE)
320
321enum {
322 SIZEOF_ICMP_HDR = 8,
323 rcvsock = 3,
324 sndsock = 4,
325};
326
327
328struct outdata_t {
329 unsigned char seq;
330 unsigned char ttl;
331
332 struct timeval tv_UNUSED PACKED;
333};
334
335#if ENABLE_TRACEROUTE6
336struct outdata6_t {
337 uint32_t ident6;
338 uint32_t seq6;
339 struct timeval tv_UNUSED PACKED;
340};
341#endif
342
343struct globals {
344 struct ip *outip;
345 struct outdata_t *outdata;
346 len_and_sockaddr *dest_lsa;
347 int packlen;
348 int pmtu;
349 uint32_t ident;
350 uint16_t port;
351 int waittime;
352#if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
353 int optlen;
354#else
355#define optlen 0
356#endif
357 unsigned char recv_pkt[512];
358#if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
359
360#define NGATEWAYS ((int)((MAX_IPOPTLEN - IPOPT_MINOFF - 1) / sizeof(uint32_t)))
361
362 uint32_t gwlist[NGATEWAYS + 1];
363#endif
364};
365
366#define G (*ptr_to_globals)
367#define outip (G.outip )
368#define outdata (G.outdata )
369#define dest_lsa (G.dest_lsa )
370#define packlen (G.packlen )
371#define pmtu (G.pmtu )
372#define ident (G.ident )
373#define port (G.port )
374#define waittime (G.waittime )
375#if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
376# define optlen (G.optlen )
377#endif
378#define recv_pkt (G.recv_pkt )
379#define gwlist (G.gwlist )
380#define INIT_G() do { \
381 SET_PTR_TO_GLOBALS(xzalloc(sizeof(G))); \
382 port = 32768 + 666; \
383 waittime = 5; \
384} while (0)
385
386#define outicmp ((struct icmp *)(outip + 1))
387#define outudp ((struct udphdr *)(outip + 1))
388
389
390
391static len_and_sockaddr* dup_sockaddr(const len_and_sockaddr *lsa)
392{
393 len_and_sockaddr *new_lsa = xzalloc(LSA_LEN_SIZE + lsa->len);
394 memcpy(new_lsa, lsa, LSA_LEN_SIZE + lsa->len);
395 return new_lsa;
396}
397
398
399static int
400wait_for_reply(len_and_sockaddr *from_lsa, struct sockaddr *to, unsigned *timestamp_us, int *left_ms)
401{
402 struct pollfd pfd[1];
403 int read_len = 0;
404
405 pfd[0].fd = rcvsock;
406 pfd[0].events = POLLIN;
407 if (*left_ms >= 0 && safe_poll(pfd, 1, *left_ms) > 0) {
408 unsigned t;
409
410 read_len = recv_from_to(rcvsock,
411 recv_pkt, sizeof(recv_pkt),
412 MSG_DONTWAIT,
413 &from_lsa->u.sa, to, from_lsa->len);
414 t = monotonic_us();
415 *left_ms -= (t - *timestamp_us) / 1000;
416 *timestamp_us = t;
417 }
418
419 return read_len;
420}
421
422static void
423send_probe(int seq, int ttl)
424{
425 int len, res;
426 void *out;
427
428
429#if ENABLE_TRACEROUTE6
430 if (dest_lsa->u.sa.sa_family == AF_INET6) {
431 struct outdata6_t *pkt = (struct outdata6_t *) outip;
432 pkt->ident6 = htonl(ident);
433 pkt->seq6 = htonl(seq);
434
435 } else
436#endif
437 {
438 outdata->seq = seq;
439 outdata->ttl = ttl;
440
441
442
443 if (option_mask32 & OPT_USE_ICMP) {
444 outicmp->icmp_seq = htons(seq);
445
446
447 outicmp->icmp_cksum = 0;
448 outicmp->icmp_cksum = inet_cksum((uint16_t *)outicmp,
449 packlen - (sizeof(*outip) + optlen));
450 if (outicmp->icmp_cksum == 0)
451 outicmp->icmp_cksum = 0xffff;
452 }
453 }
454
455
456#if 0
457
458 if (verbose > 1) {
459 const uint16_t *sp;
460 int nshorts, i;
461
462 sp = (uint16_t *)outip;
463 nshorts = (unsigned)packlen / sizeof(uint16_t);
464 i = 0;
465 printf("[ %d bytes", packlen);
466 while (--nshorts >= 0) {
467 if ((i++ % 8) == 0)
468 printf("\n\t");
469 printf(" %04x", ntohs(*sp));
470 sp++;
471 }
472 if (packlen & 1) {
473 if ((i % 8) == 0)
474 printf("\n\t");
475 printf(" %02x", *(unsigned char *)sp);
476 }
477 printf("]\n");
478 }
479#endif
480
481#if ENABLE_TRACEROUTE6
482 if (dest_lsa->u.sa.sa_family == AF_INET6) {
483 res = setsockopt(sndsock, SOL_IPV6, IPV6_UNICAST_HOPS, &ttl, sizeof(ttl));
484 if (res < 0)
485 bb_perror_msg_and_die("setsockopt UNICAST_HOPS %d", ttl);
486 out = outip;
487 len = packlen;
488 } else
489#endif
490 {
491#if defined IP_TTL
492 res = setsockopt(sndsock, IPPROTO_IP, IP_TTL, &ttl, sizeof(ttl));
493 if (res < 0)
494 bb_perror_msg_and_die("setsockopt ttl %d", ttl);
495#endif
496 out = outicmp;
497 len = packlen - sizeof(*outip);
498 if (!(option_mask32 & OPT_USE_ICMP)) {
499 out = outdata;
500 len -= sizeof(*outudp);
501 set_nport(&dest_lsa->u.sa, htons(port + seq));
502 }
503 }
504
505 res = xsendto(sndsock, out, len, &dest_lsa->u.sa, dest_lsa->len);
506 if (res != len)
507 bb_info_msg("sent %d octets, ret=%d", len, res);
508}
509
510#if ENABLE_FEATURE_TRACEROUTE_VERBOSE
511
512
513
514static const char *
515pr_type(unsigned char t)
516{
517 static const char *const ttab[] = {
518 "Echo Reply", "ICMP 1", "ICMP 2", "Dest Unreachable",
519 "Source Quench", "Redirect", "ICMP 6", "ICMP 7",
520 "Echo", "Router Advert", "Router Solicit", "Time Exceeded",
521 "Param Problem", "Timestamp", "Timestamp Reply", "Info Request",
522 "Info Reply", "Mask Request", "Mask Reply"
523 };
524# if ENABLE_TRACEROUTE6
525 static const char *const ttab6[] = {
526[0] "Error", "Dest Unreachable", "Packet Too Big", "Time Exceeded",
527[4] "Param Problem",
528[8] "Echo Request", "Echo Reply", "Membership Query", "Membership Report",
529[12] "Membership Reduction", "Router Solicit", "Router Advert", "Neighbor Solicit",
530[16] "Neighbor Advert", "Redirect",
531 };
532
533 if (dest_lsa->u.sa.sa_family == AF_INET6) {
534 if (t < 5)
535 return ttab6[t];
536 if (t < 128 || t > ND_REDIRECT)
537 return "OUT-OF-RANGE";
538 return ttab6[(t & 63) + 8];
539 }
540# endif
541 if (t >= ARRAY_SIZE(ttab))
542 return "OUT-OF-RANGE";
543
544 return ttab[t];
545}
546#endif
547
548#if !ENABLE_FEATURE_TRACEROUTE_VERBOSE
549#define packet4_ok(read_len, from, seq) \
550 packet4_ok(read_len, seq)
551#endif
552static int
553packet4_ok(int read_len, const struct sockaddr_in *from, int seq)
554{
555 const struct icmp *icp;
556 unsigned char type, code;
557 int hlen;
558 const struct ip *ip;
559
560 ip = (struct ip *) recv_pkt;
561 hlen = ip->ip_hl << 2;
562 if (read_len < hlen + ICMP_MINLEN) {
563#if ENABLE_FEATURE_TRACEROUTE_VERBOSE
564 if (verbose)
565 printf("packet too short (%d bytes) from %s\n", read_len,
566 inet_ntoa(from->sin_addr));
567#endif
568 return 0;
569 }
570 read_len -= hlen;
571 icp = (struct icmp *)(recv_pkt + hlen);
572 type = icp->icmp_type;
573 code = icp->icmp_code;
574
575 pmtu = 0;
576 if (code == ICMP_UNREACH_NEEDFRAG)
577 pmtu = ntohs(icp->icmp_nextmtu);
578
579 if ((type == ICMP_TIMXCEED && code == ICMP_TIMXCEED_INTRANS)
580 || type == ICMP_UNREACH
581 || type == ICMP_ECHOREPLY
582 ) {
583 const struct ip *hip;
584 const struct udphdr *up;
585
586 hip = &icp->icmp_ip;
587 hlen = hip->ip_hl << 2;
588 if (option_mask32 & OPT_USE_ICMP) {
589 struct icmp *hicmp;
590
591
592 if (type == ICMP_ECHOREPLY
593 && icp->icmp_id == htons(ident)
594 && icp->icmp_seq == htons(seq)
595 ) {
596 return ICMP_UNREACH_PORT+1;
597 }
598
599 hicmp = (struct icmp *)((unsigned char *)hip + hlen);
600 if (hlen + SIZEOF_ICMP_HDR <= read_len
601 && hip->ip_p == IPPROTO_ICMP
602 && hicmp->icmp_id == htons(ident)
603 && hicmp->icmp_seq == htons(seq)
604 ) {
605 return (type == ICMP_TIMXCEED ? -1 : code + 1);
606 }
607 } else {
608 up = (struct udphdr *)((char *)hip + hlen);
609 if (hlen + 12 <= read_len
610 && hip->ip_p == IPPROTO_UDP
611
612
613
614
615 && up->dest == htons(port + seq)
616 ) {
617 return (type == ICMP_TIMXCEED ? -1 : code + 1);
618 }
619 }
620 }
621#if ENABLE_FEATURE_TRACEROUTE_VERBOSE
622 if (verbose) {
623 int i;
624 uint32_t *lp = (uint32_t *)&icp->icmp_ip;
625
626 printf("\n%d bytes from %s to "
627 "%s: icmp type %d (%s) code %d\n",
628 read_len, inet_ntoa(from->sin_addr),
629 inet_ntoa(ip->ip_dst),
630 type, pr_type(type), icp->icmp_code);
631 for (i = 4; i < read_len; i += sizeof(*lp))
632 printf("%2d: x%8.8x\n", i, *lp++);
633 }
634#endif
635 return 0;
636}
637
638#if ENABLE_TRACEROUTE6
639# if !ENABLE_FEATURE_TRACEROUTE_VERBOSE
640#define packet_ok(read_len, from_lsa, to, seq) \
641 packet_ok(read_len, from_lsa, seq)
642# endif
643static int
644packet_ok(int read_len, len_and_sockaddr *from_lsa,
645 struct sockaddr *to,
646 int seq)
647{
648 const struct icmp6_hdr *icp;
649 unsigned char type, code;
650
651 if (from_lsa->u.sa.sa_family == AF_INET)
652 return packet4_ok(read_len, &from_lsa->u.sin, seq);
653
654 icp = (struct icmp6_hdr *) recv_pkt;
655
656 type = icp->icmp6_type;
657 code = icp->icmp6_code;
658
659 if ((type == ICMP6_TIME_EXCEEDED && code == ICMP6_TIME_EXCEED_TRANSIT)
660 || type == ICMP6_DST_UNREACH
661 ) {
662 struct ip6_hdr *hip;
663 struct udphdr *up;
664 int nexthdr;
665
666 hip = (struct ip6_hdr *)(icp + 1);
667 up = (struct udphdr *) (hip + 1);
668 nexthdr = hip->ip6_nxt;
669
670 if (nexthdr == IPPROTO_FRAGMENT) {
671 nexthdr = *(unsigned char*)up;
672 up++;
673 }
674 if (nexthdr == IPPROTO_UDP) {
675 struct outdata6_t *pkt;
676
677 pkt = (struct outdata6_t *) (up + 1);
678
679 if (ntohl(pkt->ident6) == ident
680 && ntohl(pkt->seq6) == seq
681 ) {
682 return (type == ICMP6_TIME_EXCEEDED ? -1 : (code<<8)+1);
683 }
684 }
685 }
686
687# if ENABLE_FEATURE_TRACEROUTE_VERBOSE
688 if (verbose) {
689 unsigned char *p;
690 char pa1[MAXHOSTNAMELEN];
691 char pa2[MAXHOSTNAMELEN];
692 int i;
693
694 p = (unsigned char *) (icp + 1);
695
696 printf("\n%d bytes from %s to "
697 "%s: icmp type %d (%s) code %d\n",
698 read_len,
699 inet_ntop(AF_INET6, &from_lsa->u.sin6.sin6_addr, pa1, sizeof(pa1)),
700 inet_ntop(AF_INET6, &((struct sockaddr_in6*)to)->sin6_addr, pa2, sizeof(pa2)),
701 type, pr_type(type), icp->icmp6_code);
702
703 read_len -= sizeof(struct icmp6_hdr);
704 for (i = 0; i < read_len; i++) {
705 if (i % 16 == 0)
706 printf("%04x:", i);
707 if (i % 4 == 0)
708 bb_putchar(' ');
709 printf("%02x", p[i]);
710 if ((i % 16 == 15) && (i + 1 < read_len))
711 bb_putchar('\n');
712 }
713 bb_putchar('\n');
714 }
715# endif
716
717 return 0;
718}
719#else
720static ALWAYS_INLINE int
721packet_ok(int read_len,
722 len_and_sockaddr *from_lsa IF_NOT_FEATURE_TRACEROUTE_VERBOSE(UNUSED_PARAM),
723 struct sockaddr *to UNUSED_PARAM,
724 int seq)
725{
726 return packet4_ok(read_len, &from_lsa->u.sin, seq);
727}
728#endif
729
730
731
732
733
734
735static void
736print_inetname(const struct sockaddr *from)
737{
738 char *ina = xmalloc_sockaddr2dotted_noport(from);
739
740 if (option_mask32 & OPT_ADDR_NUM) {
741 printf(" %s", ina);
742 } else {
743 char *n = NULL;
744
745 if (from->sa_family != AF_INET
746 || ((struct sockaddr_in*)from)->sin_addr.s_addr != INADDR_ANY
747 ) {
748
749 n = xmalloc_sockaddr2host_noport((struct sockaddr*)from);
750 }
751 printf(" %s (%s)", (n ? n : ina), ina);
752 free(n);
753 }
754 free(ina);
755}
756
757static void
758print(int read_len, const struct sockaddr *from, const struct sockaddr *to)
759{
760 print_inetname(from);
761
762 if (verbose) {
763 char *ina = xmalloc_sockaddr2dotted_noport(to);
764#if ENABLE_TRACEROUTE6
765 if (to->sa_family == AF_INET6) {
766 read_len -= sizeof(struct ip6_hdr);
767 } else
768#endif
769 {
770 struct ip *ip4packet = (struct ip*)recv_pkt;
771 read_len -= ip4packet->ip_hl << 2;
772 }
773 printf(" %d bytes to %s", read_len, ina);
774 free(ina);
775 }
776}
777
778static void
779print_delta_ms(unsigned t1p, unsigned t2p)
780{
781 unsigned tt = t2p - t1p;
782 printf(" %u.%03u ms", tt / 1000, tt % 1000);
783}
784
785
786
787
788
789
790static int
791common_traceroute_main(int op, char **argv)
792{
793 int minpacket;
794#ifdef IP_TOS
795 int tos = 0;
796#endif
797 int max_ttl = 30;
798 int nprobes = 3;
799 int first_ttl = 1;
800 unsigned pausemsecs = 0;
801 char *source;
802 char *device;
803 char *tos_str;
804 char *max_ttl_str;
805 char *port_str;
806 char *nprobes_str;
807 char *waittime_str;
808 char *pausemsecs_str;
809 char *first_ttl_str;
810 char *dest_str;
811#if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
812 llist_t *source_route_list = NULL;
813 int lsrr = 0;
814#endif
815#if ENABLE_TRACEROUTE6
816 sa_family_t af;
817#else
818 enum { af = AF_INET };
819#endif
820 int ttl;
821 int seq;
822 len_and_sockaddr *from_lsa;
823 struct sockaddr *lastaddr;
824 struct sockaddr *to;
825
826 INIT_G();
827
828
829 opt_complementary = "-1:x-x" IF_FEATURE_TRACEROUTE_SOURCE_ROUTE(":g::");
830 op |= getopt32(argv, OPT_STRING
831 , &tos_str, &device, &max_ttl_str, &port_str, &nprobes_str
832 , &source, &waittime_str, &pausemsecs_str, &first_ttl_str
833#if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
834 , &source_route_list
835#endif
836 );
837 argv += optind;
838
839#if 0
840 if (op & OPT_IP_CHKSUM)
841 bb_error_msg("warning: ip checksums disabled");
842#endif
843#ifdef IP_TOS
844 if (op & OPT_TOS)
845 tos = xatou_range(tos_str, 0, 255);
846#endif
847 if (op & OPT_MAX_TTL)
848 max_ttl = xatou_range(max_ttl_str, 1, 255);
849 if (op & OPT_PORT)
850 port = xatou16(port_str);
851 if (op & OPT_NPROBES)
852 nprobes = xatou_range(nprobes_str, 1, INT_MAX);
853 if (op & OPT_SOURCE) {
854
855
856
857
858 if (getuid() != 0)
859 bb_error_msg_and_die(bb_msg_you_must_be_root);
860 }
861 if (op & OPT_WAITTIME)
862 waittime = xatou_range(waittime_str, 1, 24 * 60 * 60);
863 if (op & OPT_PAUSE_MS)
864 pausemsecs = xatou_range(pausemsecs_str, 0, 60 * 60 * 1000);
865 if (op & OPT_FIRST_TTL)
866 first_ttl = xatou_range(first_ttl_str, 1, max_ttl);
867
868#if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
869 if (source_route_list) {
870 while (source_route_list) {
871 len_and_sockaddr *lsa;
872
873 if (lsrr >= NGATEWAYS)
874 bb_error_msg_and_die("no more than %d gateways", NGATEWAYS);
875 lsa = xhost_and_af2sockaddr(llist_pop(&source_route_list), 0, AF_INET);
876 gwlist[lsrr] = lsa->u.sin.sin_addr.s_addr;
877 free(lsa);
878 ++lsrr;
879 }
880 optlen = (lsrr + 1) * sizeof(gwlist[0]);
881 }
882#endif
883
884
885 minpacket = sizeof(*outip) + SIZEOF_ICMP_HDR + sizeof(*outdata) + optlen;
886 if (!(op & OPT_USE_ICMP))
887 minpacket += sizeof(*outudp) - SIZEOF_ICMP_HDR;
888#if ENABLE_TRACEROUTE6
889 af = AF_UNSPEC;
890 if (op & OPT_IPV4)
891 af = AF_INET;
892 if (op & OPT_IPV6)
893 af = AF_INET6;
894 dest_lsa = xhost_and_af2sockaddr(argv[0], port, af);
895 af = dest_lsa->u.sa.sa_family;
896 if (af == AF_INET6)
897 minpacket = sizeof(struct outdata6_t);
898#else
899 dest_lsa = xhost2sockaddr(argv[0], port);
900#endif
901 packlen = minpacket;
902 if (argv[1])
903 packlen = xatoul_range(argv[1], minpacket, 32 * 1024);
904
905
906 bb_sanitize_stdio();
907
908#if ENABLE_TRACEROUTE6
909 if (af == AF_INET6) {
910 xmove_fd(xsocket(AF_INET6, SOCK_RAW, IPPROTO_ICMPV6), rcvsock);
911# ifdef IPV6_RECVPKTINFO
912 setsockopt(rcvsock, SOL_IPV6, IPV6_RECVPKTINFO,
913 &const_int_1, sizeof(const_int_1));
914 setsockopt(rcvsock, SOL_IPV6, IPV6_2292PKTINFO,
915 &const_int_1, sizeof(const_int_1));
916# else
917 setsockopt(rcvsock, SOL_IPV6, IPV6_PKTINFO,
918 &const_int_1, sizeof(const_int_1));
919# endif
920 } else
921#endif
922 {
923 xmove_fd(xsocket(AF_INET, SOCK_RAW, IPPROTO_ICMP), rcvsock);
924 }
925
926#if TRACEROUTE_SO_DEBUG
927 if (op & OPT_DEBUG)
928 setsockopt(rcvsock, SOL_SOCKET, SO_DEBUG,
929 &const_int_1, sizeof(const_int_1));
930#endif
931 if (op & OPT_BYPASS_ROUTE)
932 setsockopt(rcvsock, SOL_SOCKET, SO_DONTROUTE,
933 &const_int_1, sizeof(const_int_1));
934
935#if ENABLE_TRACEROUTE6
936 if (af == AF_INET6) {
937 static const int two = 2;
938 if (setsockopt(rcvsock, SOL_RAW, IPV6_CHECKSUM, &two, sizeof(two)) < 0)
939 bb_perror_msg_and_die("setsockopt RAW_CHECKSUM");
940 xmove_fd(xsocket(af, SOCK_DGRAM, 0), sndsock);
941 } else
942#endif
943 {
944 if (op & OPT_USE_ICMP)
945 xmove_fd(xsocket(AF_INET, SOCK_RAW, IPPROTO_ICMP), sndsock);
946 else
947 xmove_fd(xsocket(AF_INET, SOCK_DGRAM, 0), sndsock);
948#if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE && defined IP_OPTIONS
949 if (lsrr > 0) {
950 unsigned char optlist[MAX_IPOPTLEN];
951 unsigned size;
952
953
954 gwlist[lsrr] = dest_lsa->u.sin.sin_addr.s_addr;
955 ++lsrr;
956
957
958 optlist[0] = IPOPT_NOP;
959
960 optlist[1] = IPOPT_LSRR;
961 size = lsrr * sizeof(gwlist[0]);
962 optlist[2] = size + 3;
963
964 optlist[3] = IPOPT_MINOFF;
965 memcpy(optlist + 4, gwlist, size);
966
967 if (setsockopt(sndsock, IPPROTO_IP, IP_OPTIONS,
968 (char *)optlist, size + sizeof(gwlist[0])) < 0) {
969 bb_perror_msg_and_die("IP_OPTIONS");
970 }
971 }
972#endif
973 }
974
975#ifdef SO_SNDBUF
976 if (setsockopt(sndsock, SOL_SOCKET, SO_SNDBUF, &packlen, sizeof(packlen)) < 0) {
977 bb_perror_msg_and_die("SO_SNDBUF");
978 }
979#endif
980#ifdef IP_TOS
981 if ((op & OPT_TOS) && setsockopt(sndsock, IPPROTO_IP, IP_TOS, &tos, sizeof(tos)) < 0) {
982 bb_perror_msg_and_die("setsockopt tos %d", tos);
983 }
984#endif
985#ifdef IP_DONTFRAG
986 if (op & OPT_DONT_FRAGMNT)
987 setsockopt(sndsock, IPPROTO_IP, IP_DONTFRAG,
988 &const_int_1, sizeof(const_int_1));
989#endif
990#if TRACEROUTE_SO_DEBUG
991 if (op & OPT_DEBUG)
992 setsockopt(sndsock, SOL_SOCKET, SO_DEBUG,
993 &const_int_1, sizeof(const_int_1));
994#endif
995 if (op & OPT_BYPASS_ROUTE)
996 setsockopt(sndsock, SOL_SOCKET, SO_DONTROUTE,
997 &const_int_1, sizeof(const_int_1));
998
999 outip = xzalloc(packlen);
1000
1001 ident = getpid();
1002
1003 if (af == AF_INET) {
1004 if (op & OPT_USE_ICMP) {
1005 ident |= 0x8000;
1006 outicmp->icmp_type = ICMP_ECHO;
1007 outicmp->icmp_id = htons(ident);
1008 outdata = (struct outdata_t *)((char *)outicmp + SIZEOF_ICMP_HDR);
1009 } else {
1010 outdata = (struct outdata_t *)(outudp + 1);
1011 }
1012 }
1013
1014 if (op & OPT_DEVICE)
1015 setsockopt_bindtodevice(sndsock, device);
1016
1017 if (op & OPT_SOURCE) {
1018#if ENABLE_TRACEROUTE6
1019
1020 len_and_sockaddr *source_lsa = xhost_and_af2sockaddr(source, 0, af);
1021#else
1022 len_and_sockaddr *source_lsa = xdotted2sockaddr(source, 0);
1023#endif
1024
1025 if (af == AF_INET)
1026 if (setsockopt(sndsock, IPPROTO_IP, IP_MULTICAST_IF,
1027 &source_lsa->u.sa, source_lsa->len))
1028 bb_error_msg_and_die("can't set multicast source interface");
1029
1030
1031 xbind(sndsock, &source_lsa->u.sa, source_lsa->len);
1032 free(source_lsa);
1033 }
1034#if ENABLE_TRACEROUTE6
1035 else if (af == AF_INET6) {
1036
1037 len_and_sockaddr *source_lsa;
1038
1039 int probe_fd = xsocket(af, SOCK_DGRAM, 0);
1040 if (op & OPT_DEVICE)
1041 setsockopt_bindtodevice(probe_fd, device);
1042 set_nport(&dest_lsa->u.sa, htons(1025));
1043
1044 xconnect(probe_fd, &dest_lsa->u.sa, dest_lsa->len);
1045 set_nport(&dest_lsa->u.sa, htons(port));
1046
1047
1048 source_lsa = get_sock_lsa(probe_fd);
1049 if (source_lsa == NULL)
1050 bb_error_msg_and_die("can't get probe addr");
1051
1052 close(probe_fd);
1053
1054
1055 set_nport(&source_lsa->u.sa, 0);
1056 xbind(sndsock, &source_lsa->u.sa, source_lsa->len);
1057 xbind(rcvsock, &source_lsa->u.sa, source_lsa->len);
1058
1059 free(source_lsa);
1060 }
1061#endif
1062
1063
1064 xsetgid(getgid());
1065 xsetuid(getuid());
1066
1067 dest_str = xmalloc_sockaddr2dotted_noport(&dest_lsa->u.sa);
1068 printf("traceroute to %s (%s)", argv[0], dest_str);
1069 if (ENABLE_FEATURE_CLEAN_UP) {
1070 free(dest_str);
1071 }
1072
1073 if (op & OPT_SOURCE)
1074 printf(" from %s", source);
1075 printf(", %d hops max, %d byte packets\n", max_ttl, packlen);
1076
1077 from_lsa = dup_sockaddr(dest_lsa);
1078 lastaddr = xzalloc(dest_lsa->len);
1079 to = xzalloc(dest_lsa->len);
1080 seq = 0;
1081 for (ttl = first_ttl; ttl <= max_ttl; ++ttl) {
1082 int probe;
1083 int unreachable = 0;
1084 int gotlastaddr = 0;
1085 int got_there = 0;
1086
1087 printf("%2d", ttl);
1088 for (probe = 0; probe < nprobes; ++probe) {
1089 int read_len;
1090 unsigned t1;
1091 unsigned t2;
1092 int left_ms;
1093 struct ip *ip;
1094
1095 fflush_all();
1096 if (probe != 0 && pausemsecs > 0)
1097 usleep(pausemsecs * 1000);
1098
1099 send_probe(++seq, ttl);
1100 t2 = t1 = monotonic_us();
1101
1102 left_ms = waittime * 1000;
1103 while ((read_len = wait_for_reply(from_lsa, to, &t2, &left_ms)) != 0) {
1104 int icmp_code;
1105
1106
1107
1108
1109 if (read_len < 0)
1110 continue;
1111 icmp_code = packet_ok(read_len, from_lsa, to, seq);
1112
1113 if (icmp_code == 0)
1114 continue;
1115
1116 if (!gotlastaddr
1117 || (memcmp(lastaddr, &from_lsa->u.sa, from_lsa->len) != 0)
1118 ) {
1119 print(read_len, &from_lsa->u.sa, to);
1120 memcpy(lastaddr, &from_lsa->u.sa, from_lsa->len);
1121 gotlastaddr = 1;
1122 }
1123
1124 print_delta_ms(t1, t2);
1125 ip = (struct ip *)recv_pkt;
1126
1127 if (from_lsa->u.sa.sa_family == AF_INET)
1128 if (op & OPT_TTL_FLAG)
1129 printf(" (%d)", ip->ip_ttl);
1130
1131
1132 if (icmp_code == -1)
1133 break;
1134 icmp_code--;
1135 switch (icmp_code) {
1136#if ENABLE_TRACEROUTE6
1137 case ICMP6_DST_UNREACH_NOPORT << 8:
1138 got_there = 1;
1139 break;
1140#endif
1141 case ICMP_UNREACH_PORT:
1142 if (ip->ip_ttl <= 1)
1143 printf(" !");
1144 got_there = 1;
1145 break;
1146
1147 case ICMP_UNREACH_NET:
1148#if ENABLE_TRACEROUTE6 && (ICMP6_DST_UNREACH_NOROUTE != ICMP_UNREACH_NET)
1149 case ICMP6_DST_UNREACH_NOROUTE << 8:
1150#endif
1151 printf(" !N");
1152 ++unreachable;
1153 break;
1154 case ICMP_UNREACH_HOST:
1155#if ENABLE_TRACEROUTE6
1156 case ICMP6_DST_UNREACH_ADDR << 8:
1157#endif
1158 printf(" !H");
1159 ++unreachable;
1160 break;
1161 case ICMP_UNREACH_PROTOCOL:
1162 printf(" !P");
1163 got_there = 1;
1164 break;
1165 case ICMP_UNREACH_NEEDFRAG:
1166 printf(" !F-%d", pmtu);
1167 ++unreachable;
1168 break;
1169 case ICMP_UNREACH_SRCFAIL:
1170#if ENABLE_TRACEROUTE6
1171 case ICMP6_DST_UNREACH_ADMIN << 8:
1172#endif
1173 printf(" !S");
1174 ++unreachable;
1175 break;
1176 case ICMP_UNREACH_FILTER_PROHIB:
1177 case ICMP_UNREACH_NET_PROHIB:
1178 printf(" !A");
1179 ++unreachable;
1180 break;
1181 case ICMP_UNREACH_HOST_PROHIB:
1182 printf(" !C");
1183 ++unreachable;
1184 break;
1185 case ICMP_UNREACH_HOST_PRECEDENCE:
1186 printf(" !V");
1187 ++unreachable;
1188 break;
1189 case ICMP_UNREACH_PRECEDENCE_CUTOFF:
1190 printf(" !C");
1191 ++unreachable;
1192 break;
1193 case ICMP_UNREACH_NET_UNKNOWN:
1194 case ICMP_UNREACH_HOST_UNKNOWN:
1195 printf(" !U");
1196 ++unreachable;
1197 break;
1198 case ICMP_UNREACH_ISOLATED:
1199 printf(" !I");
1200 ++unreachable;
1201 break;
1202 case ICMP_UNREACH_TOSNET:
1203 case ICMP_UNREACH_TOSHOST:
1204 printf(" !T");
1205 ++unreachable;
1206 break;
1207 default:
1208 printf(" !<%d>", icmp_code);
1209 ++unreachable;
1210 break;
1211 }
1212 break;
1213 }
1214
1215
1216 if (read_len == 0)
1217 printf(" *");
1218 }
1219
1220 bb_putchar('\n');
1221 if (got_there
1222 || (unreachable > 0 && unreachable >= nprobes - 1)
1223 ) {
1224 break;
1225 }
1226 }
1227
1228 if (ENABLE_FEATURE_CLEAN_UP) {
1229 free(to);
1230 free(lastaddr);
1231 free(from_lsa);
1232 }
1233
1234 return 0;
1235}
1236
1237int traceroute_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
1238int traceroute_main(int argc UNUSED_PARAM, char **argv)
1239{
1240 return common_traceroute_main(0, argv);
1241}
1242
1243#if ENABLE_TRACEROUTE6
1244int traceroute6_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
1245int traceroute6_main(int argc UNUSED_PARAM, char **argv)
1246{
1247 return common_traceroute_main(OPT_IPV6, argv);
1248}
1249#endif
1250