From 4c06531d5e2b053b642cea6fc4e7bc91ea4cbd26 Mon Sep 17 00:00:00 2001 From: Leonid Lisovskiy Date: Mon, 23 Nov 2009 06:20:09 +0100 Subject: [PATCH] traceroute6: new applet by Leonid Lisovskiy. +1562 bytes Signed-off-by: Leonid Lisovskiy Signed-off-by: Denys Vlasenko --- include/applets.h | 1 + include/usage.h | 27 ++- networking/Config.in | 7 + networking/traceroute.c | 502 +++++++++++++++++++++++++++++++--------- 4 files changed, 428 insertions(+), 109 deletions(-) diff --git a/include/applets.h b/include/applets.h index a2d1e95a5..d1a84eeaf 100644 --- a/include/applets.h +++ b/include/applets.h @@ -395,6 +395,7 @@ IF_TOP(APPLET(top, _BB_DIR_USR_BIN, _BB_SUID_DROP)) IF_TOUCH(APPLET_NOFORK(touch, touch, _BB_DIR_BIN, _BB_SUID_DROP, touch)) IF_TR(APPLET(tr, _BB_DIR_USR_BIN, _BB_SUID_DROP)) IF_TRACEROUTE(APPLET(traceroute, _BB_DIR_USR_BIN, _BB_SUID_MAYBE)) +IF_TRACEROUTE6(APPLET(traceroute6, _BB_DIR_USR_BIN, _BB_SUID_MAYBE)) IF_TRUE(APPLET_NOFORK(true, true, _BB_DIR_BIN, _BB_SUID_DROP, true)) IF_TTY(APPLET(tty, _BB_DIR_USR_BIN, _BB_SUID_DROP)) IF_TTYSIZE(APPLET(ttysize, _BB_DIR_USR_BIN, _BB_SUID_DROP)) diff --git a/include/usage.h b/include/usage.h index 3ccf160bd..920f8e8c9 100644 --- a/include/usage.h +++ b/include/usage.h @@ -4648,17 +4648,18 @@ "hello world\n" #define traceroute_trivial_usage \ - "[-FIldnrv] [-f 1st_ttl] [-m max_ttl] [-p port#] [-q nqueries]\n" \ + "[-46FIldnrv] [-f 1st_ttl] [-m max_ttl] [-p port#] [-q nqueries]\n" \ " [-s src_addr] [-t tos] [-w wait] [-g gateway] [-i iface]\n" \ " [-z pausemsecs] HOST [data size]" #define traceroute_full_usage "\n\n" \ "Trace the route to HOST\n" \ "\nOptions:" \ + "\n -4, -6 Force IPv4 or IPv6 hostname resolution" \ "\n -F Set the don't fragment bit" \ "\n -I Use ICMP ECHO instead of UDP datagrams" \ "\n -l Display the ttl value of the returned packet" \ "\n -d Set SO_DEBUG options to socket" \ - "\n -n Print hop addresses numerically rather than symbolically" \ + "\n -n Print numeric addresses" \ "\n -r Bypass the normal routing tables and send directly to a host" \ "\n -v Verbose" \ "\n -m max_ttl Max time-to-live (max number of hops)" \ @@ -4668,9 +4669,29 @@ "\n -s src_addr IP address to use as the source address" \ "\n -t tos Type-of-service in probe packets (default 0)" \ "\n -w wait Time in seconds to wait for a response" \ - "\n (default 3 sec)" \ + "\n (default 3)" \ "\n -g Loose source route gateway (8 max)" \ +#define traceroute6_trivial_usage \ + "[-dnrv] [-m max_ttl] [-p port#] [-q nqueries]\n" \ + " [-s src_addr] [-t tos] [-w wait] [-i iface]\n" \ + " HOST [data size]" +#define traceroute6_full_usage "\n\n" \ + "Trace the route to HOST\n" \ + "\nOptions:" \ + "\n -d Set SO_DEBUG options to socket" \ + "\n -n Print numeric addresses" \ + "\n -r Bypass the normal routing tables and send directly to a host" \ + "\n -v Verbose" \ + "\n -m max_ttl Max time-to-live (max number of hops)" \ + "\n -p port# Base UDP port number used in probes" \ + "\n (default is 33434)" \ + "\n -q nqueries Number of probes per 'ttl' (default 3)" \ + "\n -s src_addr IP address to use as the source address" \ + "\n -t tos Type-of-service in probe packets (default 0)" \ + "\n -w wait Time in seconds to wait for a response" \ + "\n (default 3)" \ + #define true_trivial_usage \ "" #define true_full_usage "\n\n" \ diff --git a/networking/Config.in b/networking/Config.in index 3d29622da..668823784 100644 --- a/networking/Config.in +++ b/networking/Config.in @@ -888,6 +888,13 @@ config TRACEROUTE help Utility to trace the route of IP packets. +config TRACEROUTE6 + bool "traceroute6" + default n + depends on FEATURE_IPV6 && TRACEROUTE + help + Utility to trace the route of IPv6 packets. + config FEATURE_TRACEROUTE_VERBOSE bool "Enable verbose output" default n diff --git a/networking/traceroute.c b/networking/traceroute.c index d36ddee14..18a8c25d4 100644 --- a/networking/traceroute.c +++ b/networking/traceroute.c @@ -22,6 +22,23 @@ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. */ +/* + * traceroute6 + * + * Modified for NRL 4.4BSD IPv6 release. + * 07/31/96 bgp + * + * Modified for Linux IPv6 by Pedro Roque + * 31/07/1996 + * + * As ICMP error messages for IPv6 now include more than 8 bytes + * UDP datagrams are now sent via an UDP socket instead of magic + * RAW socket tricks. + * + * Converted to busybox applet by Leonid Lisovskiy + * 2009-11-16 + */ + /* * traceroute host - trace the route ip packets follow going to "host". * @@ -231,7 +248,8 @@ #define OPT_STRING "FIlnrdvxt:i:m:p:q:s:w:z:f:" \ - IF_FEATURE_TRACEROUTE_SOURCE_ROUTE("g:") + IF_FEATURE_TRACEROUTE_SOURCE_ROUTE("g:") \ + "4" IF_TRACEROUTE6("6") enum { OPT_DONT_FRAGMNT = (1 << 0), /* F */ OPT_USE_ICMP = (1 << 1) * ENABLE_FEATURE_TRACEROUTE_USE_ICMP, /* I */ @@ -250,6 +268,9 @@ enum { OPT_WAITTIME = (1 << 14), /* w */ OPT_PAUSE_MS = (1 << 15), /* z */ OPT_FIRST_TTL = (1 << 16), /* f */ + OPT_SOURCE_ROUTE = (1 << 17) * ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE, /* g */ + OPT_IPV4 = (1 << (17+ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE)), /* 4 */ + OPT_IPV6 = (1 << (18+ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE)) * ENABLE_TRACEROUTE6, /* 6 */ }; #define verbose (option_mask32 & OPT_VERBOSE) @@ -267,13 +288,21 @@ struct outdata_t { struct timeval tv_UNUSED PACKED; /* time packet left */ }; +#if ENABLE_TRACEROUTE6 +struct outdata6_t { + uint32_t ident6; + uint32_t seq6; + struct timeval tv_UNUSED PACKED; /* time packet left */ +}; +#endif + struct globals { struct ip *outip; struct outdata_t *outdata; len_and_sockaddr *dest_lsa; int packlen; /* total length of packet */ int pmtu; /* Path MTU Discovery (RFC1191) */ - uint16_t ident; + uint32_t ident; uint16_t port; // 32768 + 666; /* start udp dest port # for probe packets */ int waittime; // 5; /* time to wait for response (in seconds) */ #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE @@ -314,18 +343,30 @@ struct globals { #define outudp ((struct udphdr *)(outip + 1)) +/* libbb candidate? tftp uses this idiom too */ +static len_and_sockaddr* dup_sockaddr(const len_and_sockaddr *lsa) +{ + len_and_sockaddr *new_lsa = xzalloc(LSA_LEN_SIZE + lsa->len); + memcpy(new_lsa, lsa, LSA_LEN_SIZE + lsa->len); + return new_lsa; +} + + static int -wait_for_reply(struct sockaddr_in *fromp) +wait_for_reply(len_and_sockaddr *from_lsa, struct sockaddr *to) { struct pollfd pfd[1]; int read_len = 0; - socklen_t fromlen = sizeof(*fromp); pfd[0].fd = rcvsock; pfd[0].events = POLLIN; - if (safe_poll(pfd, 1, waittime * 1000) > 0) - read_len = recvfrom(rcvsock, recv_pkt, sizeof(recv_pkt), 0, - (struct sockaddr *)fromp, &fromlen); + if (safe_poll(pfd, 1, waittime * 1000) > 0) { + read_len = recv_from_to(rcvsock, + recv_pkt, sizeof(recv_pkt), + /*flags:*/ 0, + &from_lsa->u.sa, to, from_lsa->len); + } + return read_len; } @@ -369,20 +410,30 @@ send_probe(int seq, int ttl) void *out; /* Payload */ - outdata->seq = seq; - outdata->ttl = ttl; +#if ENABLE_TRACEROUTE6 + if (dest_lsa->u.sa.sa_family == AF_INET6) { + struct outdata6_t *pkt = (struct outdata6_t *) outip; + pkt->ident6 = htonl(ident); + pkt->seq6 = htonl(seq); + /*gettimeofday(&pkt->tv, &tz);*/ + } else +#endif + { + outdata->seq = seq; + outdata->ttl = ttl; // UNUSED: was storing gettimeofday's result there, but never ever checked it - /*memcpy(&outdata->tv, tp, sizeof(outdata->tv));*/ - - if (option_mask32 & OPT_USE_ICMP) { - outicmp->icmp_seq = htons(seq); + /*memcpy(&outdata->tv, tp, sizeof(outdata->tv));*/ - /* Always calculate checksum for icmp packets */ - outicmp->icmp_cksum = 0; - outicmp->icmp_cksum = in_cksum((uint16_t *)outicmp, - packlen - (sizeof(*outip) + optlen)); - if (outicmp->icmp_cksum == 0) - outicmp->icmp_cksum = 0xffff; + if (option_mask32 & OPT_USE_ICMP) { + outicmp->icmp_seq = htons(seq); + + /* Always calculate checksum for icmp packets */ + outicmp->icmp_cksum = 0; + outicmp->icmp_cksum = in_cksum((uint16_t *)outicmp, + packlen - (sizeof(*outip) + optlen)); + if (outicmp->icmp_cksum == 0) + outicmp->icmp_cksum = 0xffff; + } } //BUG! verbose is (x & OPT_VERBOSE), not a counter! @@ -411,21 +462,32 @@ send_probe(int seq, int ttl) } #endif +#if ENABLE_TRACEROUTE6 + if (dest_lsa->u.sa.sa_family == AF_INET6) { + res = setsockopt(sndsock, SOL_IPV6, IPV6_UNICAST_HOPS, &ttl, sizeof(ttl)); + if (res < 0) + bb_perror_msg_and_die("setsockopt UNICAST_HOPS %d", ttl); + out = outip; + len = packlen; + } else +#endif + { #if defined(IP_TTL) - if (setsockopt(sndsock, IPPROTO_IP, IP_TTL, + if (setsockopt(sndsock, IPPROTO_IP, IP_TTL, (char *)&ttl, sizeof(ttl)) < 0) { - bb_perror_msg_and_die("setsockopt ttl %d", ttl); - } + bb_perror_msg_and_die("setsockopt ttl %d", ttl); + } #endif - - len = packlen - sizeof(*outip); - if (option_mask32 & OPT_USE_ICMP) - out = outicmp; - else { - out = outdata; - len -= sizeof(*outudp); - set_nport(dest_lsa, htons(port + seq)); + len = packlen - sizeof(*outip); + if (option_mask32 & OPT_USE_ICMP) + out = outicmp; + else { + out = outdata; + len -= sizeof(*outudp); + set_nport(dest_lsa, htons(port + seq)); + } } + res = xsendto(sndsock, out, len, &dest_lsa->u.sa, dest_lsa->len); if (res != len) { bb_info_msg("sent %d octets, ret=%d", len, res); @@ -436,7 +498,7 @@ send_probe(int seq, int ttl) /* * Convert an ICMP "type" field to a printable string. */ -static inline const char * +static const char * pr_type(unsigned char t) { static const char *const ttab[] = { @@ -446,7 +508,23 @@ pr_type(unsigned char t) "Param Problem", "Timestamp", "Timestamp Reply", "Info Request", "Info Reply", "Mask Request", "Mask Reply" }; +# if ENABLE_TRACEROUTE6 + static const char *const ttab6[] = { +[0] "Error", "Dest Unreachable", "Packet Too Big", "Time Exceeded", +[4] "Param Problem", +[8] "Echo Request", "Echo Reply", "Membership Query", "Membership Report", +[12] "Membership Reduction", "Router Solicit", "Router Advert", "Neighbor Solicit", +[16] "Neighbor Advert", "Redirect", + }; + if (dest_lsa->u.sa.sa_family == AF_INET6) { + if (t < 5) + return ttab6[t]; + if (t < 128 || t > ND_REDIRECT) + return "OUT-OF-RANGE"; + return ttab6[(t & 63) + 8]; + } +# endif if (t >= ARRAY_SIZE(ttab)) return "OUT-OF-RANGE"; @@ -455,11 +533,11 @@ pr_type(unsigned char t) #endif #if !ENABLE_FEATURE_TRACEROUTE_VERBOSE -#define packet_ok(read_len, from, seq) \ - packet_ok(read_len, seq) +#define packet4_ok(read_len, from, seq) \ + packet4_ok(read_len, seq) #endif static int -packet_ok(int read_len, const struct sockaddr_in *from, int seq) +packet4_ok(int read_len, const struct sockaddr_in *from, int seq) { const struct icmp *icp; unsigned char type, code; @@ -502,7 +580,7 @@ packet_ok(int read_len, const struct sockaddr_in *from, int seq) && icp->icmp_id == htons(ident) && icp->icmp_seq == htons(seq) ) { - return -2; + return ICMP_UNREACH_PORT+1; } hicmp = (struct icmp *)((unsigned char *)hip + hlen); @@ -544,6 +622,98 @@ packet_ok(int read_len, const struct sockaddr_in *from, int seq) return 0; } +#if ENABLE_TRACEROUTE6 +# if !ENABLE_FEATURE_TRACEROUTE_VERBOSE +#define packet_ok(read_len, from_lsa, to, seq) \ + packet_ok(read_len, from_lsa, seq) +# endif +static int +packet_ok(int read_len, len_and_sockaddr *from_lsa, + struct sockaddr *to, + int seq) +{ + const struct icmp6_hdr *icp; + unsigned char type, code; + + if (from_lsa->u.sa.sa_family == AF_INET) + return packet4_ok(read_len, &from_lsa->u.sin, seq); + + icp = (struct icmp6_hdr *) recv_pkt; + + type = icp->icmp6_type; + code = icp->icmp6_code; + + if ((type == ICMP6_TIME_EXCEEDED && code == ICMP6_TIME_EXCEED_TRANSIT) + || type == ICMP6_DST_UNREACH + ) { + struct ip6_hdr *hip; + struct udphdr *up; + int nexthdr; + + hip = (struct ip6_hdr *)(icp + 1); + up = (struct udphdr *) (hip + 1); + nexthdr = hip->ip6_nxt; + + if (nexthdr == IPPROTO_FRAGMENT) { + nexthdr = *(unsigned char*)up; + up++; + } + if (nexthdr == IPPROTO_UDP) { + struct outdata6_t *pkt; + + pkt = (struct outdata6_t *) (up + 1); + + if (ntohl(pkt->ident6) == ident + && ntohl(pkt->seq6) == seq + ) { + return (type == ICMP6_TIME_EXCEEDED ? -1 : (code<<8)+1); + } + } + + } + +# if ENABLE_FEATURE_TRACEROUTE_VERBOSE + if (verbose) { + unsigned char *p; + char pa1[MAXHOSTNAMELEN]; + char pa2[MAXHOSTNAMELEN]; + int i; + + p = (unsigned char *) (icp + 1); + + printf("\n%d bytes from %s to " + "%s: icmp type %d (%s) code %d\n", + read_len, + inet_ntop(AF_INET6, &from_lsa->u.sin6.sin6_addr, pa1, sizeof(pa1)), + inet_ntop(AF_INET6, &((struct sockaddr_in6*)to)->sin6_addr, pa2, sizeof(pa2)), + type, pr_type(type), icp->icmp6_code); + + read_len -= sizeof(struct icmp6_hdr); + for (i = 0; i < read_len ; i++) { + if (i % 16 == 0) + printf("%04x:", i); + if (i % 4 == 0) + bb_putchar(' '); + printf("%02x", p[i]); + if ((i % 16 == 15) && (i + 1 < read_len)) + bb_putchar('\n'); + } + bb_putchar('\n'); + } +# endif + + return 0; +} +#else /* !ENABLE_TRACEROUTE6 */ +static ALWAYS_INLINE int +packet_ok(int read_len, len_and_sockaddr *from_lsa, + struct sockaddr *to UNUSED_PARAM, + int seq) +{ + return packet4_ok(read_len, &from_lsa->u.sin, seq); +} +#endif + /* * Construct an Internet address representation. * If the -n flag has been supplied, give @@ -572,17 +742,22 @@ print_inetname(const struct sockaddr *from) } static void -print(int read_len, const struct sockaddr_in *from) +print(int read_len, const struct sockaddr *from, const struct sockaddr *to) { - print_inetname((const struct sockaddr*)from); - if (verbose) { - const struct ip *ip; - int hlen; + print_inetname(from); - ip = (struct ip *) recv_pkt; - hlen = ip->ip_hl << 2; - read_len -= hlen; - printf(" %d bytes to %s", read_len, inet_ntoa(ip->ip_dst)); + if (verbose) { + char *ina = xmalloc_sockaddr2dotted_noport(to); +#if ENABLE_TRACEROUTE6 + if (to->sa_family == AF_INET6) { + read_len -= sizeof(struct ip6_hdr); + } else +#endif + { + read_len -= ((struct ip*)recv_pkt)->ip_hl << 2; + } + printf(" %d bytes to %s", read_len, ina); + free(ina); } } @@ -598,9 +773,8 @@ print_delta_ms(unsigned t1p, unsigned t2p) * [-m max_ttl] [ -p port] [-q nqueries] [-s src_addr] [-t tos] * [-w waittime] [-z pausemsecs] host [packetlen]" */ - -int traceroute_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE; -int traceroute_main(int argc UNUSED_PARAM, char **argv) +static int +common_traceroute_main(int op, char **argv) { int i; int minpacket; @@ -609,7 +783,6 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) int nprobes = 3; int first_ttl = 1; unsigned pausemsecs = 0; - unsigned op; char *source; char *device; char *tos_str; @@ -622,21 +795,30 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE llist_t *source_route_list = NULL; int lsrr = 0; +#endif +#if ENABLE_TRACEROUTE6 + sa_family_t af = AF_UNSPEC; +#else + enum { af = AF_INET }; #endif int ttl; int seq; + len_and_sockaddr *from_lsa; + struct sockaddr *lastaddr; + struct sockaddr *to; INIT_G(); /* minimum 1 arg */ opt_complementary = "-1:x-x" IF_FEATURE_TRACEROUTE_SOURCE_ROUTE(":g::"); - op = getopt32(argv, OPT_STRING + op |= getopt32(argv, OPT_STRING , &tos_str, &device, &max_ttl_str, &port_str, &nprobes_str , &source, &waittime_str, &pausemsecs_str, &first_ttl_str #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE , &source_route_list #endif ); + argv += optind; #if 0 /* IGNORED */ if (op & OPT_IP_CHKSUM) @@ -681,21 +863,53 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) } #endif - minpacket = sizeof(*outip) + SIZEOF_ICMP_HDR + sizeof(*outdata) + optlen; - if (!(op & OPT_USE_ICMP)) - minpacket += sizeof(*outudp) - SIZEOF_ICMP_HDR; +#if ENABLE_TRACEROUTE6 + if (op & OPT_IPV4) + af = AF_INET; + if (op & OPT_IPV6) { + af = AF_INET6; + minpacket = sizeof(struct outdata6_t); + } else +#endif + { + minpacket = sizeof(*outip) + SIZEOF_ICMP_HDR + + sizeof(*outdata) + optlen; + if (!(op & OPT_USE_ICMP)) + minpacket += sizeof(*outudp) - SIZEOF_ICMP_HDR; + } packlen = minpacket; /* Process destination and optional packet size */ - argv += optind; if (argv[1]) packlen = xatoul_range(argv[1], minpacket, 32 * 1024); +#if ENABLE_TRACEROUTE6 + dest_lsa = xhost_and_af2sockaddr(argv[0], port, af); + af = dest_lsa->u.sa.sa_family; +#else dest_lsa = xhost2sockaddr(argv[0], port); +#endif /* Ensure the socket fds won't be 0, 1 or 2 */ bb_sanitize_stdio(); - xmove_fd(xsocket(AF_INET, SOCK_RAW, IPPROTO_ICMP), rcvsock); +#if ENABLE_TRACEROUTE6 + if (af == AF_INET6) { + xmove_fd(xsocket(AF_INET6, SOCK_RAW, IPPROTO_ICMPV6), rcvsock); +# ifdef IPV6_RECVPKTINFO + setsockopt(rcvsock, SOL_IPV6, IPV6_RECVPKTINFO, + &const_int_1, sizeof(const_int_1)); + setsockopt(rcvsock, SOL_IPV6, IPV6_2292PKTINFO, + &const_int_1, sizeof(const_int_1)); +# else + setsockopt(rcvsock, SOL_IPV6, IPV6_PKTINFO, + &const_int_1, sizeof(const_int_1)); +# endif + } else +#endif + { + xmove_fd(xsocket(AF_INET, SOCK_RAW, IPPROTO_ICMP), rcvsock); + } + #if TRACEROUTE_SO_DEBUG if (op & OPT_DEBUG) setsockopt(rcvsock, SOL_SOCKET, SO_DEBUG, @@ -705,34 +919,45 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) setsockopt(rcvsock, SOL_SOCKET, SO_DONTROUTE, &const_int_1, sizeof(const_int_1)); - if (op & OPT_USE_ICMP) - xmove_fd(xsocket(AF_INET, SOCK_RAW, IPPROTO_ICMP), sndsock); - else - xmove_fd(xsocket(AF_INET, SOCK_DGRAM, 0), sndsock); +#if ENABLE_TRACEROUTE6 + if (af == AF_INET6) { + static const int two = 2; + if (setsockopt(rcvsock, SOL_RAW, IPV6_CHECKSUM, &two, sizeof(two)) < 0) + bb_perror_msg_and_die("setsockopt RAW_CHECKSUM"); + xmove_fd(xsocket(af, SOCK_DGRAM, 0), sndsock); + } else +#endif + { + if (op & OPT_USE_ICMP) + xmove_fd(xsocket(AF_INET, SOCK_RAW, IPPROTO_ICMP), sndsock); + else + xmove_fd(xsocket(AF_INET, SOCK_DGRAM, 0), sndsock); #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE && defined IP_OPTIONS - if (lsrr > 0) { - unsigned char optlist[MAX_IPOPTLEN]; - - /* final hop */ - gwlist[lsrr] = dest_lsa->u.sin.sin_addr.s_addr; - ++lsrr; - - /* force 4 byte alignment */ - optlist[0] = IPOPT_NOP; - /* loose source route option */ - optlist[1] = IPOPT_LSRR; - i = lsrr * sizeof(gwlist[0]); - optlist[2] = i + 3; - /* pointer to LSRR addresses */ - optlist[3] = IPOPT_MINOFF; - memcpy(optlist + 4, gwlist, i); - - if (setsockopt(sndsock, IPPROTO_IP, IP_OPTIONS, - (char *)optlist, i + sizeof(gwlist[0])) < 0) { - bb_perror_msg_and_die("IP_OPTIONS"); + if (lsrr > 0) { + unsigned char optlist[MAX_IPOPTLEN]; + + /* final hop */ + gwlist[lsrr] = dest_lsa->u.sin.sin_addr.s_addr; + ++lsrr; + + /* force 4 byte alignment */ + optlist[0] = IPOPT_NOP; + /* loose source route option */ + optlist[1] = IPOPT_LSRR; + i = lsrr * sizeof(gwlist[0]); + optlist[2] = i + 3; + /* pointer to LSRR addresses */ + optlist[3] = IPOPT_MINOFF; + memcpy(optlist + 4, gwlist, i); + + if (setsockopt(sndsock, IPPROTO_IP, IP_OPTIONS, + (char *)optlist, i + sizeof(gwlist[0])) < 0) { + bb_perror_msg_and_die("IP_OPTIONS"); + } } - } #endif + } + #ifdef SO_SNDBUF if (setsockopt(sndsock, SOL_SOCKET, SO_SNDBUF, &packlen, sizeof(packlen)) < 0) { bb_perror_msg_and_die("SO_SNDBUF"); @@ -759,29 +984,66 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) outip = xzalloc(packlen); - if (op & OPT_USE_ICMP) { - ident = getpid() | 0x8000; - outicmp->icmp_type = ICMP_ECHO; - outicmp->icmp_id = htons(ident); - outdata = (struct outdata_t *)((char *)outicmp + SIZEOF_ICMP_HDR); - } else { - outdata = (struct outdata_t *)(outudp + 1); + ident = getpid(); + + if (af == AF_INET) { + if (op & OPT_USE_ICMP) { + ident |= 0x8000; + outicmp->icmp_type = ICMP_ECHO; + outicmp->icmp_id = htons(ident); + outdata = (struct outdata_t *)((char *)outicmp + SIZEOF_ICMP_HDR); + } else { + outdata = (struct outdata_t *)(outudp + 1); + } } if (op & OPT_DEVICE) /* hmm, do we need error check? */ setsockopt_bindtodevice(sndsock, device); if (op & OPT_SOURCE) { +#if ENABLE_TRACEROUTE6 +// TODO: need xdotted_and_af2sockaddr? + len_and_sockaddr *source_lsa = xhost_and_af2sockaddr(source, 0, af); +#else len_and_sockaddr *source_lsa = xdotted2sockaddr(source, 0); - /* Ping does this (why?) */ - if (setsockopt(sndsock, IPPROTO_IP, IP_MULTICAST_IF, - &source_lsa->u.sa, source_lsa->len)) - bb_error_msg_and_die("can't set multicast source interface"); +#endif + /* Ping4 does this (why?) */ + if (af == AF_INET) + if (setsockopt(sndsock, IPPROTO_IP, IP_MULTICAST_IF, + &source_lsa->u.sa, source_lsa->len)) + bb_error_msg_and_die("can't set multicast source interface"); //TODO: we can query source port we bound to, // and check it in replies... if we care enough xbind(sndsock, &source_lsa->u.sa, source_lsa->len); free(source_lsa); } +#if ENABLE_TRACEROUTE6 + else if (af == AF_INET6) { +//TODO: why we don't do it for IPv4? + len_and_sockaddr *source_lsa; + + int probe_fd = xsocket(af, SOCK_DGRAM, 0); + if (op & OPT_DEVICE) + setsockopt_bindtodevice(probe_fd, device); + set_nport(dest_lsa, htons(1025)); + /* dummy connect. makes kernel pick source IP (and port) */ + xconnect(probe_fd, &dest_lsa->u.sa, dest_lsa->len); + + /* read IP and port */ + source_lsa = get_sock_lsa(probe_fd); + if (source_lsa == NULL) + bb_error_msg_and_die("can't get probe addr"); + + close(probe_fd); + + /* bind our sockets to this IP (but not port) */ + set_nport(source_lsa, 0); + xbind(sndsock, &source_lsa->u.sa, source_lsa->len); + xbind(rcvsock, &source_lsa->u.sa, source_lsa->len); + + free(source_lsa); + } +#endif /* Revert to non-privileged user after opening sockets */ xsetgid(getgid()); @@ -793,11 +1055,11 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) printf(" from %s", source); printf(", %d hops max, %d byte packets\n", max_ttl, packlen); + from_lsa = dup_sockaddr(dest_lsa); + lastaddr = xzalloc(dest_lsa->len); + to = xzalloc(dest_lsa->len); seq = 0; for (ttl = first_ttl; ttl <= max_ttl; ++ttl) { -//TODO: make it protocol agnostic (get rid of sockaddr_in) - struct sockaddr_in from; - uint32_t lastaddr = 0; int probe; int unreachable = 0; /* counter */ int gotlastaddr = 0; /* flags */ @@ -819,44 +1081,55 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) send_probe(++seq, ttl); first = 0; - while ((read_len = wait_for_reply(&from)) != 0) { + while ((read_len = wait_for_reply(from_lsa, to)) != 0) { t2 = monotonic_us(); - i = packet_ok(read_len, &from, seq); + i = packet_ok(read_len, from_lsa, to, seq); /* Skip short packet */ if (i == 0) continue; + if (!gotlastaddr - || from.sin_addr.s_addr != lastaddr + || (memcmp(lastaddr, &from_lsa->u.sa, from_lsa->len) != 0) ) { - print(read_len, &from); - lastaddr = from.sin_addr.s_addr; + print(read_len, &from_lsa->u.sa, to); + memcpy(lastaddr, &from_lsa->u.sa, from_lsa->len); gotlastaddr = 1; } + print_delta_ms(t1, t2); ip = (struct ip *)recv_pkt; - if (op & OPT_TTL_FLAG) - printf(" (%d)", ip->ip_ttl); - if (i == -2) { - if (ip->ip_ttl <= 1) - printf(" !"); - got_there = 1; - break; - } + + if (from_lsa->u.sa.sa_family == AF_INET) + if (op & OPT_TTL_FLAG) + printf(" (%d)", ip->ip_ttl); + /* time exceeded in transit */ if (i == -1) break; i--; switch (i) { +#if ENABLE_TRACEROUTE6 + case ICMP6_DST_UNREACH_NOPORT << 8: + got_there = 1; + break; +#endif case ICMP_UNREACH_PORT: if (ip->ip_ttl <= 1) printf(" !"); got_there = 1; break; + case ICMP_UNREACH_NET: +#if ENABLE_TRACEROUTE6 && (ICMP6_DST_UNREACH_NOROUTE != ICMP_UNREACH_NET) + case ICMP6_DST_UNREACH_NOROUTE << 8: +#endif printf(" !N"); ++unreachable; break; case ICMP_UNREACH_HOST: +#if ENABLE_TRACEROUTE6 + case ICMP6_DST_UNREACH_ADDR << 8: +#endif printf(" !H"); ++unreachable; break; @@ -869,6 +1142,9 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) ++unreachable; break; case ICMP_UNREACH_SRCFAIL: +#if ENABLE_TRACEROUTE6 + case ICMP6_DST_UNREACH_ADMIN << 8: +#endif printf(" !S"); ++unreachable; break; @@ -924,3 +1200,17 @@ int traceroute_main(int argc UNUSED_PARAM, char **argv) return 0; } + +int traceroute_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE; +int traceroute_main(int argc UNUSED_PARAM, char **argv) +{ + return common_traceroute_main(0, argv); +} + +#if ENABLE_TRACEROUTE6 +int traceroute6_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE; +int traceroute6_main(int argc UNUSED_PARAM, char **argv) +{ + return common_traceroute_main(OPT_IPV6, argv); +} +#endif -- 2.25.1