networking/traceroute.c

   1 /* vi: set sw=4 ts=4: */
   2 /*
   3  * Copyright (c) 1988, 1989, 1991, 1994, 1995, 1996, 1997, 1998, 1999, 2000
   4  *      The Regents of the University of California.  All rights reserved.
   5  *
   6  * Busybox port by Vladimir Oleynik (C) 2005 <dzo@simtreas.ru>
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that: (1) source code distributions
  10  * retain the above copyright notice and this paragraph in its entirety, (2)
  11  * distributions including binary code include the above copyright notice and
  12  * this paragraph in its entirety in the documentation or other materials
  13  * provided with the distribution, and (3) all advertising materials mentioning
  14  * features or use of this software display the following acknowledgement:
  15  * ``This product includes software developed by the University of California,
  16  * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
  17  * the University nor the names of its contributors may be used to endorse
  18  * or promote products derived from this software without specific prior
  19  * written permission.
  20  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
  21  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
  22  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  23  */
  24
  25 /*
  26  *      traceroute6
  27  *
  28  *      Modified for NRL 4.4BSD IPv6 release.
  29  *      07/31/96 bgp
  30  *
  31  *      Modified for Linux IPv6 by Pedro Roque <roque@di.fc.ul.pt>
  32  *      31/07/1996
  33  *
  34  *      As ICMP error messages for IPv6 now include more than 8 bytes
  35  *      UDP datagrams are now sent via an UDP socket instead of magic
  36  *      RAW socket tricks.
  37  *
  38  *      Converted to busybox applet by Leonid Lisovskiy <lly@sf.net>
  39  *      2009-11-16
  40  */
  41
  42 /*
  43  * traceroute host  - trace the route ip packets follow going to "host".
  44  *
  45  * Attempt to trace the route an ip packet would follow to some
  46  * internet host.  We find out intermediate hops by launching probe
  47  * packets with a small ttl (time to live) then listening for an
  48  * icmp "time exceeded" reply from a gateway.  We start our probes
  49  * with a ttl of one and increase by one until we get an icmp "port
  50  * unreachable" (which means we got to "host") or hit a max (which
  51  * defaults to 30 hops & can be changed with the -m flag).  Three
  52  * probes (change with -q flag) are sent at each ttl setting and a
  53  * line is printed showing the ttl, address of the gateway and
  54  * round trip time of each probe.  If the probe answers come from
  55  * different gateways, the address of each responding system will
  56  * be printed.  If there is no response within a 5 sec. timeout
  57  * interval (changed with the -w flag), a "*" is printed for that
  58  * probe.
  59  *
  60  * Probe packets are UDP format.  We don't want the destination
  61  * host to process them so the destination port is set to an
  62  * unlikely value (if some clod on the destination is using that
  63  * value, it can be changed with the -p flag).
  64  *
  65  * A sample use might be:
  66  *
  67  *     [yak 71]% traceroute nis.nsf.net.
  68  *     traceroute to nis.nsf.net (35.1.1.48), 30 hops max, 56 byte packet
  69  *      1  helios.ee.lbl.gov (128.3.112.1)  19 ms  19 ms  0 ms
  70  *      2  lilac-dmc.Berkeley.EDU (128.32.216.1)  39 ms  39 ms  19 ms
  71  *      3  lilac-dmc.Berkeley.EDU (128.32.216.1)  39 ms  39 ms  19 ms
  72  *      4  ccngw-ner-cc.Berkeley.EDU (128.32.136.23)  39 ms  40 ms  39 ms
  73  *      5  ccn-nerif22.Berkeley.EDU (128.32.168.22)  39 ms  39 ms  39 ms
  74  *      6  128.32.197.4 (128.32.197.4)  40 ms  59 ms  59 ms
  75  *      7  131.119.2.5 (131.119.2.5)  59 ms  59 ms  59 ms
  76  *      8  129.140.70.13 (129.140.70.13)  99 ms  99 ms  80 ms
  77  *      9  129.140.71.6 (129.140.71.6)  139 ms  239 ms  319 ms
  78  *     10  129.140.81.7 (129.140.81.7)  220 ms  199 ms  199 ms
  79  *     11  nic.merit.edu (35.1.1.48)  239 ms  239 ms  239 ms
  80  *
  81  * Note that lines 2 & 3 are the same.  This is due to a buggy
  82  * kernel on the 2nd hop system -- lbl-csam.arpa -- that forwards
  83  * packets with a zero ttl.
  84  *
  85  * A more interesting example is:
  86  *
  87  *     [yak 72]% traceroute allspice.lcs.mit.edu.
  88  *     traceroute to allspice.lcs.mit.edu (18.26.0.115), 30 hops max
  89  *      1  helios.ee.lbl.gov (128.3.112.1)  0 ms  0 ms  0 ms
  90  *      2  lilac-dmc.Berkeley.EDU (128.32.216.1)  19 ms  19 ms  19 ms
  91  *      3  lilac-dmc.Berkeley.EDU (128.32.216.1)  39 ms  19 ms  19 ms
  92  *      4  ccngw-ner-cc.Berkeley.EDU (128.32.136.23)  19 ms  39 ms  39 ms
  93  *      5  ccn-nerif22.Berkeley.EDU (128.32.168.22)  20 ms  39 ms  39 ms
  94  *      6  128.32.197.4 (128.32.197.4)  59 ms  119 ms  39 ms
  95  *      7  131.119.2.5 (131.119.2.5)  59 ms  59 ms  39 ms
  96  *      8  129.140.70.13 (129.140.70.13)  80 ms  79 ms  99 ms
  97  *      9  129.140.71.6 (129.140.71.6)  139 ms  139 ms  159 ms
  98  *     10  129.140.81.7 (129.140.81.7)  199 ms  180 ms  300 ms
  99  *     11  129.140.72.17 (129.140.72.17)  300 ms  239 ms  239 ms
 100  *     12  * * *
 101  *     13  128.121.54.72 (128.121.54.72)  259 ms  499 ms  279 ms
 102  *     14  * * *
 103  *     15  * * *
 104  *     16  * * *
 105  *     17  * * *
 106  *     18  ALLSPICE.LCS.MIT.EDU (18.26.0.115)  339 ms  279 ms  279 ms
 107  *
 108  * (I start to see why I'm having so much trouble with mail to
 109  * MIT.)  Note that the gateways 12, 14, 15, 16 & 17 hops away
 110  * either don't send ICMP "time exceeded" messages or send them
 111  * with a ttl too small to reach us.  14 - 17 are running the
 112  * MIT C Gateway code that doesn't send "time exceeded"s.  God
 113  * only knows what's going on with 12.
 114  *
 115  * The silent gateway 12 in the above may be the result of a bug in
 116  * the 4.[23]BSD network code (and its derivatives):  4.x (x <= 3)
 117  * sends an unreachable message using whatever ttl remains in the
 118  * original datagram.  Since, for gateways, the remaining ttl is
 119  * zero, the icmp "time exceeded" is guaranteed to not make it back
 120  * to us.  The behavior of this bug is slightly more interesting
 121  * when it appears on the destination system:
 122  *
 123  *      1  helios.ee.lbl.gov (128.3.112.1)  0 ms  0 ms  0 ms
 124  *      2  lilac-dmc.Berkeley.EDU (128.32.216.1)  39 ms  19 ms  39 ms
 125  *      3  lilac-dmc.Berkeley.EDU (128.32.216.1)  19 ms  39 ms  19 ms
 126  *      4  ccngw-ner-cc.Berkeley.EDU (128.32.136.23)  39 ms  40 ms  19 ms
 127  *      5  ccn-nerif35.Berkeley.EDU (128.32.168.35)  39 ms  39 ms  39 ms
 128  *      6  csgw.Berkeley.EDU (128.32.133.254)  39 ms  59 ms  39 ms
 129  *      7  * * *
 130  *      8  * * *
 131  *      9  * * *
 132  *     10  * * *
 133  *     11  * * *
 134  *     12  * * *
 135  *     13  rip.Berkeley.EDU (128.32.131.22)  59 ms !  39 ms !  39 ms !
 136  *
 137  * Notice that there are 12 "gateways" (13 is the final
 138  * destination) and exactly the last half of them are "missing".
 139  * What's really happening is that rip (a Sun-3 running Sun OS3.5)
 140  * is using the ttl from our arriving datagram as the ttl in its
 141  * icmp reply.  So, the reply will time out on the return path
 142  * (with no notice sent to anyone since icmp's aren't sent for
 143  * icmp's) until we probe with a ttl that's at least twice the path
 144  * length.  I.e., rip is really only 7 hops away.  A reply that
 145  * returns with a ttl of 1 is a clue this problem exists.
 146  * Traceroute prints a "!" after the time if the ttl is <= 1.
 147  * Since vendors ship a lot of obsolete (DEC's Ultrix, Sun 3.x) or
 148  * non-standard (HPUX) software, expect to see this problem
 149  * frequently and/or take care picking the target host of your
 150  * probes.
 151  *
 152  * Other possible annotations after the time are !H, !N, !P (got a host,
 153  * network or protocol unreachable, respectively), !S or !F (source
 154  * route failed or fragmentation needed -- neither of these should
 155  * ever occur and the associated gateway is busted if you see one).  If
 156  * almost all the probes result in some kind of unreachable, traceroute
 157  * will give up and exit.
 158  *
 159  * Notes
 160  * -----
 161  * This program must be run by root or be setuid.  (I suggest that
 162  * you *don't* make it setuid -- casual use could result in a lot
 163  * of unnecessary traffic on our poor, congested nets.)
 164  *
 165  * This program requires a kernel mod that does not appear in any
 166  * system available from Berkeley:  A raw ip socket using proto
 167  * IPPROTO_RAW must interpret the data sent as an ip datagram (as
 168  * opposed to data to be wrapped in a ip datagram).  See the README
 169  * file that came with the source to this program for a description
 170  * of the mods I made to /sys/netinet/raw_ip.c.  Your mileage may
 171  * vary.  But, again, ANY 4.x (x < 4) BSD KERNEL WILL HAVE TO BE
 172  * MODIFIED TO RUN THIS PROGRAM.
 173  *
 174  * The udp port usage may appear bizarre (well, ok, it is bizarre).
 175  * The problem is that an icmp message only contains 8 bytes of
 176  * data from the original datagram.  8 bytes is the size of a udp
 177  * header so, if we want to associate replies with the original
 178  * datagram, the necessary information must be encoded into the
 179  * udp header (the ip id could be used but there's no way to
 180  * interlock with the kernel's assignment of ip id's and, anyway,
 181  * it would have taken a lot more kernel hacking to allow this
 182  * code to set the ip id).  So, to allow two or more users to
 183  * use traceroute simultaneously, we use this task's pid as the
 184  * source port (the high bit is set to move the port number out
 185  * of the "likely" range).  To keep track of which probe is being
 186  * replied to (so times and/or hop counts don't get confused by a
 187  * reply that was delayed in transit), we increment the destination
 188  * port number before each probe.
 189  *
 190  * Don't use this as a coding example.  I was trying to find a
 191  * routing problem and this code sort-of popped out after 48 hours
 192  * without sleep.  I was amazed it ever compiled, much less ran.
 193  *
 194  * I stole the idea for this program from Steve Deering.  Since
 195  * the first release, I've learned that had I attended the right
 196  * IETF working group meetings, I also could have stolen it from Guy
 197  * Almes or Matt Mathis.  I don't know (or care) who came up with
 198  * the idea first.  I envy the originators' perspicacity and I'm
 199  * glad they didn't keep the idea a secret.
 200  *
 201  * Tim Seaver, Ken Adelman and C. Philip Wood provided bug fixes and/or
 202  * enhancements to the original distribution.
 203  *
 204  * I've hacked up a round-trip-route version of this that works by
 205  * sending a loose-source-routed udp datagram through the destination
 206  * back to yourself.  Unfortunately, SO many gateways botch source
 207  * routing, the thing is almost worthless.  Maybe one day...
 208  *
 209  *  -- Van Jacobson (van@ee.lbl.gov)
 210  *     Tue Dec 20 03:50:13 PST 1988
 211  */
 212
 213 //usage:#define traceroute_trivial_usage
 214 //usage:       "[-"IF_TRACEROUTE6("46")"FIlnrv] [-f 1ST_TTL] [-m MAXTTL] [-q PROBES] [-p PORT]\n"
 215 //usage:       "        [-t TOS] [-w WAIT_SEC]"
 216 //usage:       IF_FEATURE_TRACEROUTE_SOURCE_ROUTE(" [-g GATEWAY]")" [-s SRC_IP] [-i IFACE]\n"
 217 //usage:       "        [-z PAUSE_MSEC] HOST [BYTES]"
 218 //usage:#define traceroute_full_usage "\n\n"
 219 //usage:       "Trace the route to HOST\n"
 220 //usage:        IF_TRACEROUTE6(
 221 //usage:     "\n        -4,-6   Force IP or IPv6 name resolution"
 222 //usage:        )
 223 //usage:     "\n        -F      Set don't fragment bit"
 224 //usage:        IF_FEATURE_TRACEROUTE_USE_ICMP(
 225 //usage:     "\n        -I      Use ICMP ECHO instead of UDP datagrams"
 226 //usage:        )
 227 //usage:     "\n        -l      Display TTL value of the returned packet"
 228 //Currently disabled (TRACEROUTE_SO_DEBUG==0)
 229 ////usage:     "\n      -d      Set SO_DEBUG options to socket"
 230 //usage:     "\n        -n      Print numeric addresses"
 231 //usage:     "\n        -r      Bypass routing tables, send directly to HOST"
 232 //usage:        IF_FEATURE_TRACEROUTE_VERBOSE(
 233 //usage:     "\n        -v      Verbose"
 234 //usage:        )
 235 //usage:     "\n        -f N    First number of hops (default 1)"
 236 //usage:     "\n        -m N    Max number of hops"
 237 //usage:     "\n        -q N    Number of probes per hop (default 3)"
 238 //usage:     "\n        -p N    Base UDP port number used in probes"
 239 //usage:     "\n                (default 33434)"
 240 //usage:     "\n        -s IP   Source address"
 241 //usage:     "\n        -i IFACE Source interface"
 242 //usage:     "\n        -t N    Type-of-service in probe packets (default 0)"
 243 //usage:     "\n        -w SEC  Time to wait for a response (default 3)"
 244 //usage:     "\n        -g IP   Loose source route gateway (8 max)"
 245 //usage:
 246 //usage:#define traceroute6_trivial_usage
 247 //usage:       "[-nrv] [-m MAXTTL] [-q PROBES] [-p PORT]\n"
 248 //usage:       "        [-t TOS] [-w WAIT_SEC] [-s SRC_IP] [-i IFACE]\n"
 249 //usage:       "        HOST [BYTES]"
 250 //usage:#define traceroute6_full_usage "\n\n"
 251 //usage:       "Trace the route to HOST\n"
 252 //Currently disabled (TRACEROUTE_SO_DEBUG==0)
 253 ////usage:     "\n      -d      Set SO_DEBUG options to socket"
 254 //usage:     "\n        -n      Print numeric addresses"
 255 //usage:     "\n        -r      Bypass routing tables, send directly to HOST"
 256 //usage:        IF_FEATURE_TRACEROUTE_VERBOSE(
 257 //usage:     "\n        -v      Verbose"
 258 //usage:        )
 259 //usage:     "\n        -m N    Max number of hops"
 260 //usage:     "\n        -q N    Number of probes per hop (default 3)"
 261 //usage:     "\n        -p N    Base UDP port number used in probes"
 262 //usage:     "\n                (default 33434)"
 263 //usage:     "\n        -s IP   Source address"
 264 //usage:     "\n        -i IFACE Source interface"
 265 //usage:     "\n        -t N    Type-of-service in probe packets (default 0)"
 266 //usage:     "\n        -w SEC  Time wait for a response (default 3)"
 267
 268 #define TRACEROUTE_SO_DEBUG 0
 269
 270 #include <net/if.h>
 271 #include <arpa/inet.h>
 272 #include <netinet/in.h>
 273 #include <netinet/udp.h>
 274 #include <netinet/ip.h>
 275 #include <netinet/ip_icmp.h>
 276 #if ENABLE_FEATURE_IPV6
 277 # include <netinet/ip6.h>
 278 # include <netinet/icmp6.h>
 279 # ifndef SOL_IPV6
 280 #  define SOL_IPV6 IPPROTO_IPV6
 281 # endif
 282 #endif
 283
 284 #include "libbb.h"
 285 #include "inet_common.h"
 286
 287 #ifndef IPPROTO_ICMP
 288 # define IPPROTO_ICMP 1
 289 #endif
 290 #ifndef IPPROTO_IP
 291 # define IPPROTO_IP 0
 292 #endif
 293
 294
 295 #define OPT_STRING \
 296         "FIlnrdvxt:i:m:p:q:s:w:z:f:" \
 297         IF_FEATURE_TRACEROUTE_SOURCE_ROUTE("g:*") \
 298         "4" IF_TRACEROUTE6("6")
 299 enum {
 300         OPT_DONT_FRAGMNT = (1 << 0),    /* F */
 301         OPT_USE_ICMP     = (1 << 1) * ENABLE_FEATURE_TRACEROUTE_USE_ICMP, /* I */
 302         OPT_TTL_FLAG     = (1 << 2),    /* l */
 303         OPT_ADDR_NUM     = (1 << 3),    /* n */
 304         OPT_BYPASS_ROUTE = (1 << 4),    /* r */
 305         OPT_DEBUG        = (1 << 5),    /* d */
 306         OPT_VERBOSE      = (1 << 6) * ENABLE_FEATURE_TRACEROUTE_VERBOSE, /* v */
 307         OPT_IP_CHKSUM    = (1 << 7),    /* x */
 308         OPT_TOS          = (1 << 8),    /* t */
 309         OPT_DEVICE       = (1 << 9),    /* i */
 310         OPT_MAX_TTL      = (1 << 10),   /* m */
 311         OPT_PORT         = (1 << 11),   /* p */
 312         OPT_NPROBES      = (1 << 12),   /* q */
 313         OPT_SOURCE       = (1 << 13),   /* s */
 314         OPT_WAITTIME     = (1 << 14),   /* w */
 315         OPT_PAUSE_MS     = (1 << 15),   /* z */
 316         OPT_FIRST_TTL    = (1 << 16),   /* f */
 317         OPT_SOURCE_ROUTE = (1 << 17) * ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE, /* g */
 318         OPT_IPV4         = (1 << (17+ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE)),   /* 4 */
 319         OPT_IPV6         = (1 << (18+ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE)) * ENABLE_TRACEROUTE6, /* 6 */
 320 };
 321 #define verbose (option_mask32 & OPT_VERBOSE)
 322
 323 enum {
 324         SIZEOF_ICMP_HDR = 8,
 325         rcvsock = 3, /* receive (icmp) socket file descriptor */
 326         sndsock = 4, /* send (udp/icmp) socket file descriptor */
 327 };
 328
 329 /* Data section of the probe packet */
 330 struct outdata_t {
 331         unsigned char seq;             /* sequence number of this packet */
 332         unsigned char ttl;             /* ttl packet left with */
 333 // UNUSED. Retaining to have the same packet size.
 334         struct timeval tv_UNUSED PACKED; /* time packet left */
 335 };
 336
 337 #if ENABLE_TRACEROUTE6
 338 struct outdata6_t {
 339         uint32_t ident6;
 340         uint32_t seq6;
 341         struct timeval tv_UNUSED PACKED; /* time packet left */
 342 };
 343 #endif
 344
 345 struct globals {
 346         struct ip *outip;
 347         struct outdata_t *outdata;
 348         len_and_sockaddr *dest_lsa;
 349         int packlen;                    /* total length of packet */
 350         int pmtu;                       /* Path MTU Discovery (RFC1191) */
 351         uint32_t ident;
 352         uint16_t port; // 32768 + 666;  /* start udp dest port # for probe packets */
 353         int waittime; // 5;             /* time to wait for response (in seconds) */
 354 #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
 355         int optlen;                     /* length of ip options */
 356 #else
 357 #define optlen 0
 358 #endif
 359         unsigned char recv_pkt[512];    /* last inbound (icmp) packet */
 360 #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
 361         /* Maximum number of gateways (include room for one noop) */
 362 #define NGATEWAYS ((int)((MAX_IPOPTLEN - IPOPT_MINOFF - 1) / sizeof(uint32_t)))
 363         /* loose source route gateway list (including room for final destination) */
 364         uint32_t gwlist[NGATEWAYS + 1];
 365 #endif
 366 };
 367
 368 #define G (*ptr_to_globals)
 369 #define outip     (G.outip    )
 370 #define outdata   (G.outdata  )
 371 #define dest_lsa  (G.dest_lsa )
 372 #define packlen   (G.packlen  )
 373 #define pmtu      (G.pmtu     )
 374 #define ident     (G.ident    )
 375 #define port      (G.port     )
 376 #define waittime  (G.waittime )
 377 #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
 378 # define optlen   (G.optlen   )
 379 #endif
 380 #define recv_pkt  (G.recv_pkt )
 381 #define gwlist    (G.gwlist   )
 382 #define INIT_G() do { \
 383         SET_PTR_TO_GLOBALS(xzalloc(sizeof(G))); \
 384         port = 32768 + 666; \
 385         waittime = 5; \
 386 } while (0)
 387
 388 #define outicmp ((struct icmp *)(outip + 1))
 389 #define outudp  ((struct udphdr *)(outip + 1))
 390
 391
 392 static int
 393 wait_for_reply(len_and_sockaddr *from_lsa, struct sockaddr *to, unsigned *timestamp_us, int *left_ms)
 394 {
 395         struct pollfd pfd[1];
 396         int read_len = 0;
 397
 398         pfd[0].fd = rcvsock;
 399         pfd[0].events = POLLIN;
 400         if (*left_ms >= 0 && safe_poll(pfd, 1, *left_ms) > 0) {
 401                 unsigned t;
 402
 403                 read_len = recv_from_to(rcvsock,
 404                                 recv_pkt, sizeof(recv_pkt),
 405                                 /*flags:*/ MSG_DONTWAIT,
 406                                 &from_lsa->u.sa, to, from_lsa->len);
 407                 t = monotonic_us();
 408                 *left_ms -= (t - *timestamp_us) / 1000;
 409                 *timestamp_us = t;
 410         }
 411
 412         return read_len;
 413 }
 414
 415 static void
 416 send_probe(int seq, int ttl)
 417 {
 418         int len, res;
 419         void *out;
 420
 421         /* Payload */
 422 #if ENABLE_TRACEROUTE6
 423         if (dest_lsa->u.sa.sa_family == AF_INET6) {
 424                 struct outdata6_t *pkt = (struct outdata6_t *) outip;
 425                 pkt->ident6 = htonl(ident);
 426                 pkt->seq6   = htonl(seq);
 427                 /*gettimeofday(&pkt->tv, &tz);*/
 428         } else
 429 #endif
 430         {
 431                 outdata->seq = seq;
 432                 outdata->ttl = ttl;
 433 // UNUSED: was storing gettimeofday's result there, but never ever checked it
 434                 /*memcpy(&outdata->tv, tp, sizeof(outdata->tv));*/
 435
 436                 if (option_mask32 & OPT_USE_ICMP) {
 437                         outicmp->icmp_seq = htons(seq);
 438
 439                         /* Always calculate checksum for icmp packets */
 440                         outicmp->icmp_cksum = 0;
 441                         outicmp->icmp_cksum = inet_cksum((uint16_t *)outicmp,
 442                                                 packlen - (sizeof(*outip) + optlen));
 443                         if (outicmp->icmp_cksum == 0)
 444                                 outicmp->icmp_cksum = 0xffff;
 445                 }
 446         }
 447
 448 //BUG! verbose is (x & OPT_VERBOSE), not a counter!
 449 #if 0 //ENABLE_FEATURE_TRACEROUTE_VERBOSE
 450         /* XXX undocumented debugging hack */
 451         if (verbose > 1) {
 452                 const uint16_t *sp;
 453                 int nshorts, i;
 454
 455                 sp = (uint16_t *)outip;
 456                 nshorts = (unsigned)packlen / sizeof(uint16_t);
 457                 i = 0;
 458                 printf("[ %d bytes", packlen);
 459                 while (--nshorts >= 0) {
 460                         if ((i++ % 8) == 0)
 461                                 printf("\n\t");
 462                         printf(" %04x", ntohs(*sp));
 463                         sp++;
 464                 }
 465                 if (packlen & 1) {
 466                         if ((i % 8) == 0)
 467                                 printf("\n\t");
 468                         printf(" %02x", *(unsigned char *)sp);
 469                 }
 470                 printf("]\n");
 471         }
 472 #endif
 473
 474 #if ENABLE_TRACEROUTE6
 475         if (dest_lsa->u.sa.sa_family == AF_INET6) {
 476                 res = setsockopt_int(sndsock, SOL_IPV6, IPV6_UNICAST_HOPS, ttl);
 477                 if (res != 0)
 478                         bb_perror_msg_and_die("setsockopt(%s) %d", "UNICAST_HOPS", ttl);
 479                 out = outip;
 480                 len = packlen;
 481         } else
 482 #endif
 483         {
 484 #if defined IP_TTL
 485                 res = setsockopt_int(sndsock, IPPROTO_IP, IP_TTL, ttl);
 486                 if (res != 0)
 487                         bb_perror_msg_and_die("setsockopt(%s) %d", "TTL", ttl);
 488 #endif
 489                 out = outicmp;
 490                 len = packlen - sizeof(*outip);
 491                 if (!(option_mask32 & OPT_USE_ICMP)) {
 492                         out = outdata;
 493                         len -= sizeof(*outudp);
 494                         set_nport(&dest_lsa->u.sa, htons(port + seq));
 495                 }
 496         }
 497
 498         res = xsendto(sndsock, out, len, &dest_lsa->u.sa, dest_lsa->len);
 499         if (res != len)
 500                 bb_error_msg("sent %d octets, ret=%d", len, res);
 501 }
 502
 503 #if ENABLE_FEATURE_TRACEROUTE_VERBOSE
 504 /*
 505  * Convert an ICMP "type" field to a printable string.
 506  */
 507 static const char *
 508 pr_type(unsigned char t)
 509 {
 510         static const char *const ttab[] = {
 511         "Echo Reply",   "ICMP 1",       "ICMP 2",       "Dest Unreachable",
 512         "Source Quench", "Redirect",    "ICMP 6",       "ICMP 7",
 513         "Echo",         "Router Advert", "Router Solicit", "Time Exceeded",
 514         "Param Problem", "Timestamp",   "Timestamp Reply", "Info Request",
 515         "Info Reply",   "Mask Request", "Mask Reply"
 516         };
 517 # if ENABLE_TRACEROUTE6
 518         static const char *const ttab6[] = {
 519 [0]     "Error", "Dest Unreachable", "Packet Too Big", "Time Exceeded",
 520 [4]     "Param Problem",
 521 [8]     "Echo Request", "Echo Reply", "Membership Query", "Membership Report",
 522 [12]    "Membership Reduction", "Router Solicit", "Router Advert", "Neighbor Solicit",
 523 [16]    "Neighbor Advert", "Redirect",
 524         };
 525
 526         if (dest_lsa->u.sa.sa_family == AF_INET6) {
 527                 if (t < 5)
 528                         return ttab6[t];
 529                 if (t < 128 || t > ND_REDIRECT)
 530                         return "OUT-OF-RANGE";
 531                 return ttab6[(t & 63) + 8];
 532         }
 533 # endif
 534         if (t >= ARRAY_SIZE(ttab))
 535                 return "OUT-OF-RANGE";
 536
 537         return ttab[t];
 538 }
 539 #endif
 540
 541 #if !ENABLE_FEATURE_TRACEROUTE_VERBOSE
 542 #define packet4_ok(read_len, from, seq) \
 543         packet4_ok(read_len, seq)
 544 #endif
 545 static int
 546 packet4_ok(int read_len, const struct sockaddr_in *from, int seq)
 547 {
 548         const struct icmp *icp;
 549         unsigned char type, code;
 550         int hlen;
 551         const struct ip *ip;
 552
 553         ip = (struct ip *) recv_pkt;
 554         hlen = ip->ip_hl << 2;
 555         if (read_len < hlen + ICMP_MINLEN) {
 556 #if ENABLE_FEATURE_TRACEROUTE_VERBOSE
 557                 if (verbose)
 558                         printf("packet too short (%d bytes) from %s\n", read_len,
 559                                 inet_ntoa(from->sin_addr));
 560 #endif
 561                 return 0;
 562         }
 563         read_len -= hlen;
 564         icp = (struct icmp *)(recv_pkt + hlen);
 565         type = icp->icmp_type;
 566         code = icp->icmp_code;
 567         /* Path MTU Discovery (RFC1191) */
 568         pmtu = 0;
 569         if (code == ICMP_UNREACH_NEEDFRAG)
 570                 pmtu = ntohs(icp->icmp_nextmtu);
 571
 572         if ((type == ICMP_TIMXCEED && code == ICMP_TIMXCEED_INTRANS)
 573          || type == ICMP_UNREACH
 574          || type == ICMP_ECHOREPLY
 575         ) {
 576                 const struct ip *hip;
 577                 const struct udphdr *up;
 578
 579                 hip = &icp->icmp_ip;
 580                 hlen = hip->ip_hl << 2;
 581                 if (option_mask32 & OPT_USE_ICMP) {
 582                         struct icmp *hicmp;
 583
 584                         /* XXX */
 585                         if (type == ICMP_ECHOREPLY
 586                          && icp->icmp_id == htons(ident)
 587                          && icp->icmp_seq == htons(seq)
 588                         ) {
 589                                 return ICMP_UNREACH_PORT+1;
 590                         }
 591
 592                         hicmp = (struct icmp *)((unsigned char *)hip + hlen);
 593                         if (hlen + SIZEOF_ICMP_HDR <= read_len
 594                          && hip->ip_p == IPPROTO_ICMP
 595                          && hicmp->icmp_id == htons(ident)
 596                          && hicmp->icmp_seq == htons(seq)
 597                         ) {
 598                                 return (type == ICMP_TIMXCEED ? -1 : code + 1);
 599                         }
 600                 } else {
 601                         up = (struct udphdr *)((char *)hip + hlen);
 602                         if (hlen + 12 <= read_len
 603                          && hip->ip_p == IPPROTO_UDP
 604 // Off: since we do not form the entire IP packet,
 605 // but defer it to kernel, we can't set source port,
 606 // and thus can't check it here in the reply
 607                         /* && up->source == htons(ident) */
 608                          && up->dest == htons(port + seq)
 609                         ) {
 610                                 return (type == ICMP_TIMXCEED ? -1 : code + 1);
 611                         }
 612                 }
 613         }
 614 #if ENABLE_FEATURE_TRACEROUTE_VERBOSE
 615         if (verbose) {
 616                 int i;
 617                 uint32_t *lp = (uint32_t *)&icp->icmp_ip;
 618
 619                 printf("\n%d bytes from %s to "
 620                        "%s: icmp type %d (%s) code %d\n",
 621                         read_len, inet_ntoa(from->sin_addr),
 622                         inet_ntoa(ip->ip_dst),
 623                         type, pr_type(type), icp->icmp_code);
 624                 for (i = 4; i < read_len; i += sizeof(*lp))
 625                         printf("%2d: x%8.8x\n", i, *lp++);
 626         }
 627 #endif
 628         return 0;
 629 }
 630
 631 #if ENABLE_TRACEROUTE6
 632 # if !ENABLE_FEATURE_TRACEROUTE_VERBOSE
 633 #define packet_ok(read_len, from_lsa, to, seq) \
 634         packet_ok(read_len, from_lsa, seq)
 635 # endif
 636 static int
 637 packet_ok(int read_len, len_and_sockaddr *from_lsa,
 638                         struct sockaddr *to,
 639                         int seq)
 640 {
 641         const struct icmp6_hdr *icp;
 642         unsigned char type, code;
 643
 644         if (from_lsa->u.sa.sa_family == AF_INET)
 645                 return packet4_ok(read_len, &from_lsa->u.sin, seq);
 646
 647         icp = (struct icmp6_hdr *) recv_pkt;
 648
 649         type = icp->icmp6_type;
 650         code = icp->icmp6_code;
 651
 652         if ((type == ICMP6_TIME_EXCEEDED && code == ICMP6_TIME_EXCEED_TRANSIT)
 653          || type == ICMP6_DST_UNREACH
 654         ) {
 655                 struct ip6_hdr *hip;
 656                 struct udphdr *up;
 657                 int nexthdr;
 658
 659                 hip = (struct ip6_hdr *)(icp + 1);
 660                 up  = (struct udphdr *) (hip + 1);
 661                 nexthdr = hip->ip6_nxt;
 662
 663                 if (nexthdr == IPPROTO_FRAGMENT) {
 664                         nexthdr = *(unsigned char*)up;
 665                         up++;
 666                 }
 667                 if (nexthdr == IPPROTO_UDP) {
 668                         struct outdata6_t *pkt;
 669
 670                         pkt = (struct outdata6_t *) (up + 1);
 671
 672                         if (ntohl(pkt->ident6) == ident
 673                          && ntohl(pkt->seq6) == seq
 674                         ) {
 675                                 return (type == ICMP6_TIME_EXCEEDED ? -1 : (code<<8)+1);
 676                         }
 677                 }
 678         }
 679
 680 # if ENABLE_FEATURE_TRACEROUTE_VERBOSE
 681         if (verbose) {
 682                 unsigned char *p;
 683                 char pa1[MAXHOSTNAMELEN];
 684                 char pa2[MAXHOSTNAMELEN];
 685                 int i;
 686
 687                 p = (unsigned char *) (icp + 1);
 688
 689                 printf("\n%d bytes from %s to "
 690                        "%s: icmp type %d (%s) code %d\n",
 691                         read_len,
 692                         inet_ntop(AF_INET6, &from_lsa->u.sin6.sin6_addr, pa1, sizeof(pa1)),
 693                         inet_ntop(AF_INET6, &((struct sockaddr_in6*)to)->sin6_addr, pa2, sizeof(pa2)),
 694                         type, pr_type(type), icp->icmp6_code);
 695
 696                 read_len -= sizeof(struct icmp6_hdr);
 697                 for (i = 0; i < read_len; i++) {
 698                         if (i % 16 == 0)
 699                                 printf("%04x:", i);
 700                         if (i % 4 == 0)
 701                                 bb_putchar(' ');
 702                         printf("%02x", p[i]);
 703                         if ((i % 16 == 15) && (i + 1 < read_len))
 704                                 bb_putchar('\n');
 705                 }
 706                 bb_putchar('\n');
 707         }
 708 # endif
 709
 710         return 0;
 711 }
 712 #else /* !ENABLE_TRACEROUTE6 */
 713 static ALWAYS_INLINE int
 714 packet_ok(int read_len,
 715                 len_and_sockaddr *from_lsa IF_NOT_FEATURE_TRACEROUTE_VERBOSE(UNUSED_PARAM),
 716                 struct sockaddr *to UNUSED_PARAM,
 717                 int seq)
 718 {
 719         return packet4_ok(read_len, &from_lsa->u.sin, seq);
 720 }
 721 #endif
 722
 723 /*
 724  * Construct an Internet address representation.
 725  * If the -n flag has been supplied, give
 726  * numeric value, otherwise try for symbolic name.
 727  */
 728 static void
 729 print_inetname(const struct sockaddr *from)
 730 {
 731         char *ina = xmalloc_sockaddr2dotted_noport(from);
 732
 733         if (option_mask32 & OPT_ADDR_NUM) {
 734                 printf("  %s", ina);
 735         } else {
 736                 char *n = NULL;
 737
 738                 if (from->sa_family != AF_INET
 739                  || ((struct sockaddr_in*)from)->sin_addr.s_addr != INADDR_ANY
 740                 ) {
 741                         /* Try to reverse resolve if it is not 0.0.0.0 */
 742                         n = xmalloc_sockaddr2host_noport((struct sockaddr*)from);
 743                 }
 744                 printf("  %s (%s)", (n ? n : ina), ina);
 745                 free(n);
 746         }
 747         free(ina);
 748 }
 749
 750 static void
 751 print(int read_len, const struct sockaddr *from, const struct sockaddr *to)
 752 {
 753         print_inetname(from);
 754
 755         if (verbose) {
 756                 char *ina = xmalloc_sockaddr2dotted_noport(to);
 757 #if ENABLE_TRACEROUTE6
 758                 if (to->sa_family == AF_INET6) {
 759                         read_len -= sizeof(struct ip6_hdr);
 760                 } else
 761 #endif
 762                 {
 763                         struct ip *ip4packet = (struct ip*)recv_pkt;
 764                         read_len -= ip4packet->ip_hl << 2;
 765                 }
 766                 printf(" %d bytes to %s", read_len, ina);
 767                 free(ina);
 768         }
 769 }
 770
 771 static void
 772 print_delta_ms(unsigned t1p, unsigned t2p)
 773 {
 774         unsigned tt = t2p - t1p;
 775         printf("  %u.%03u ms", tt / 1000, tt % 1000);
 776 }
 777
 778 /*
 779  * Usage: [-dFIlnrvx] [-g gateway] [-i iface] [-f first_ttl]
 780  * [-m max_ttl] [ -p port] [-q nqueries] [-s src_addr] [-t tos]
 781  * [-w waittime] [-z pausemsecs] host [packetlen]"
 782  */
 783 static int
 784 common_traceroute_main(int op, char **argv)
 785 {
 786         int minpacket;
 787 #ifdef IP_TOS
 788         int tos = 0;
 789 #endif
 790         int max_ttl = 30;
 791         int nprobes = 3;
 792         int first_ttl = 1;
 793         unsigned pausemsecs = 0;
 794         char *source;
 795         char *device;
 796         char *tos_str;
 797         char *max_ttl_str;
 798         char *port_str;
 799         char *nprobes_str;
 800         char *waittime_str;
 801         char *pausemsecs_str;
 802         char *first_ttl_str;
 803         char *dest_str;
 804 #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
 805         llist_t *source_route_list = NULL;
 806         int lsrr = 0;
 807 #endif
 808 #if ENABLE_TRACEROUTE6
 809         sa_family_t af;
 810 #else
 811         enum { af = AF_INET };
 812 #endif
 813         int ttl;
 814         int seq;
 815         len_and_sockaddr *from_lsa;
 816         struct sockaddr *lastaddr;
 817         struct sockaddr *to;
 818
 819         INIT_G();
 820
 821         /* minimum 1 arg */
 822         opt_complementary = "-1:x-x";
 823         op |= getopt32(argv, OPT_STRING
 824                 , &tos_str, &device, &max_ttl_str, &port_str, &nprobes_str
 825                 , &source, &waittime_str, &pausemsecs_str, &first_ttl_str
 826 #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
 827                 , &source_route_list
 828 #endif
 829         );
 830         argv += optind;
 831
 832 #if 0 /* IGNORED */
 833         if (op & OPT_IP_CHKSUM)
 834                 bb_error_msg("warning: ip checksums disabled");
 835 #endif
 836 #ifdef IP_TOS
 837         if (op & OPT_TOS)
 838                 tos = xatou_range(tos_str, 0, 255);
 839 #endif
 840         if (op & OPT_MAX_TTL)
 841                 max_ttl = xatou_range(max_ttl_str, 1, 255);
 842         if (op & OPT_PORT)
 843                 port = xatou16(port_str);
 844         if (op & OPT_NPROBES)
 845                 nprobes = xatou_range(nprobes_str, 1, INT_MAX);
 846         if (op & OPT_SOURCE) {
 847                 /*
 848                  * set the ip source address of the outbound
 849                  * probe (e.g., on a multi-homed host).
 850                  */
 851                 if (getuid() != 0)
 852                         bb_error_msg_and_die(bb_msg_you_must_be_root);
 853         }
 854         if (op & OPT_WAITTIME)
 855                 waittime = xatou_range(waittime_str, 1, 24 * 60 * 60);
 856         if (op & OPT_PAUSE_MS)
 857                 pausemsecs = xatou_range(pausemsecs_str, 0, 60 * 60 * 1000);
 858         if (op & OPT_FIRST_TTL)
 859                 first_ttl = xatou_range(first_ttl_str, 1, max_ttl);
 860
 861 #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE
 862         if (source_route_list) {
 863                 while (source_route_list) {
 864                         len_and_sockaddr *lsa;
 865
 866                         if (lsrr >= NGATEWAYS)
 867                                 bb_error_msg_and_die("no more than %d gateways", NGATEWAYS);
 868                         lsa = xhost_and_af2sockaddr(llist_pop(&source_route_list), 0, AF_INET);
 869                         gwlist[lsrr] = lsa->u.sin.sin_addr.s_addr;
 870                         free(lsa);
 871                         ++lsrr;
 872                 }
 873                 optlen = (lsrr + 1) * sizeof(gwlist[0]);
 874         }
 875 #endif
 876
 877         /* Process destination and optional packet size */
 878         minpacket = sizeof(*outip) + SIZEOF_ICMP_HDR + sizeof(*outdata) + optlen;
 879         if (!(op & OPT_USE_ICMP))
 880                 minpacket += sizeof(*outudp) - SIZEOF_ICMP_HDR;
 881 #if ENABLE_TRACEROUTE6
 882         af = AF_UNSPEC;
 883         if (op & OPT_IPV4)
 884                 af = AF_INET;
 885         if (op & OPT_IPV6)
 886                 af = AF_INET6;
 887         dest_lsa = xhost_and_af2sockaddr(argv[0], port, af);
 888         af = dest_lsa->u.sa.sa_family;
 889         if (af == AF_INET6)
 890                 minpacket = sizeof(struct outdata6_t);
 891 #else
 892         dest_lsa = xhost2sockaddr(argv[0], port);
 893 #endif
 894         packlen = minpacket;
 895         if (argv[1])
 896                 packlen = xatoul_range(argv[1], minpacket, 32 * 1024);
 897
 898         /* Ensure the socket fds won't be 0, 1 or 2 */
 899         bb_sanitize_stdio();
 900
 901 #if ENABLE_TRACEROUTE6
 902         if (af == AF_INET6) {
 903                 xmove_fd(xsocket(AF_INET6, SOCK_RAW, IPPROTO_ICMPV6), rcvsock);
 904 # ifdef IPV6_RECVPKTINFO
 905                 setsockopt_1(rcvsock, SOL_IPV6, IPV6_RECVPKTINFO);
 906                 setsockopt_1(rcvsock, SOL_IPV6, IPV6_2292PKTINFO);
 907 # else
 908                 setsockopt_1(rcvsock, SOL_IPV6, IPV6_PKTINFO);
 909 # endif
 910         } else
 911 #endif
 912         {
 913                 xmove_fd(xsocket(AF_INET, SOCK_RAW, IPPROTO_ICMP), rcvsock);
 914         }
 915
 916 #if TRACEROUTE_SO_DEBUG
 917         if (op & OPT_DEBUG)
 918                 setsockopt_SOL_SOCKET_1(rcvsock, SO_DEBUG);
 919 #endif
 920         if (op & OPT_BYPASS_ROUTE)
 921                 setsockopt_SOL_SOCKET_1(rcvsock, SO_DONTROUTE);
 922
 923 #if ENABLE_TRACEROUTE6
 924         if (af == AF_INET6) {
 925                 if (setsockopt_int(rcvsock, SOL_RAW, IPV6_CHECKSUM, 2) != 0)
 926                         bb_perror_msg_and_die("setsockopt(%s)", "IPV6_CHECKSUM");
 927                 xmove_fd(xsocket(af, SOCK_DGRAM, 0), sndsock);
 928         } else
 929 #endif
 930         {
 931                 if (op & OPT_USE_ICMP)
 932                         xmove_fd(xsocket(AF_INET, SOCK_RAW, IPPROTO_ICMP), sndsock);
 933                 else
 934                         xmove_fd(xsocket(AF_INET, SOCK_DGRAM, 0), sndsock);
 935 #if ENABLE_FEATURE_TRACEROUTE_SOURCE_ROUTE && defined IP_OPTIONS
 936                 if (lsrr > 0) {
 937                         unsigned char optlist[MAX_IPOPTLEN];
 938                         unsigned size;
 939
 940                         /* final hop */
 941                         gwlist[lsrr] = dest_lsa->u.sin.sin_addr.s_addr;
 942                         ++lsrr;
 943
 944                         /* force 4 byte alignment */
 945                         optlist[0] = IPOPT_NOP;
 946                         /* loose source route option */
 947                         optlist[1] = IPOPT_LSRR;
 948                         size = lsrr * sizeof(gwlist[0]);
 949                         optlist[2] = size + 3;
 950                         /* pointer to LSRR addresses */
 951                         optlist[3] = IPOPT_MINOFF;
 952                         memcpy(optlist + 4, gwlist, size);
 953
 954                         if (setsockopt(sndsock, IPPROTO_IP, IP_OPTIONS,
 955                                         (char *)optlist, size + sizeof(gwlist[0])) < 0) {
 956                                 bb_perror_msg_and_die("IP_OPTIONS");
 957                         }
 958                 }
 959 #endif
 960         }
 961
 962 #ifdef SO_SNDBUF
 963         if (setsockopt_SOL_SOCKET_int(sndsock, SO_SNDBUF, packlen) != 0) {
 964                 bb_perror_msg_and_die("setsockopt(%s)", "SO_SNDBUF");
 965         }
 966 #endif
 967 #ifdef IP_TOS
 968         if ((op & OPT_TOS) && setsockopt_int(sndsock, IPPROTO_IP, IP_TOS, tos) != 0) {
 969                 bb_perror_msg_and_die("setsockopt(%s) %d", "TOS", tos);
 970         }
 971 #endif
 972 #ifdef IP_DONTFRAG
 973         if (op & OPT_DONT_FRAGMNT)
 974                 setsockopt_1(sndsock, IPPROTO_IP, IP_DONTFRAG);
 975 #endif
 976 #if TRACEROUTE_SO_DEBUG
 977         if (op & OPT_DEBUG)
 978                 setsockopt_SOL_SOCKET_1(sndsock, SO_DEBUG);
 979 #endif
 980         if (op & OPT_BYPASS_ROUTE)
 981                 setsockopt_SOL_SOCKET_1(sndsock, SO_DONTROUTE);
 982
 983         outip = xzalloc(packlen);
 984
 985         ident = getpid();
 986
 987         if (af == AF_INET) {
 988                 if (op & OPT_USE_ICMP) {
 989                         ident |= 0x8000;
 990                         outicmp->icmp_type = ICMP_ECHO;
 991                         outicmp->icmp_id = htons(ident);
 992                         outdata = (struct outdata_t *)((char *)outicmp + SIZEOF_ICMP_HDR);
 993                 } else {
 994                         outdata = (struct outdata_t *)(outudp + 1);
 995                 }
 996         }
 997
 998         if (op & OPT_DEVICE) /* hmm, do we need error check? */
 999                 setsockopt_bindtodevice(sndsock, device);
1000
1001         if (op & OPT_SOURCE) {
1002 #if ENABLE_TRACEROUTE6
1003 // TODO: need xdotted_and_af2sockaddr?
1004                 len_and_sockaddr *source_lsa = xhost_and_af2sockaddr(source, 0, af);
1005 #else
1006                 len_and_sockaddr *source_lsa = xdotted2sockaddr(source, 0);
1007 #endif
1008                 /* Ping4 does this (why?) */
1009                 if (af == AF_INET)
1010                         if (setsockopt(sndsock, IPPROTO_IP, IP_MULTICAST_IF,
1011                                         &source_lsa->u.sa, source_lsa->len))
1012                                 bb_error_msg_and_die("can't set multicast source interface");
1013 //TODO: we can query source port we bound to,
1014 // and check it in replies... if we care enough
1015                 xbind(sndsock, &source_lsa->u.sa, source_lsa->len);
1016                 free(source_lsa);
1017         }
1018 #if ENABLE_TRACEROUTE6
1019         else if (af == AF_INET6) {
1020 //TODO: why we don't do it for IPv4?
1021                 len_and_sockaddr *source_lsa;
1022
1023                 int probe_fd = xsocket(af, SOCK_DGRAM, 0);
1024                 if (op & OPT_DEVICE)
1025                         setsockopt_bindtodevice(probe_fd, device);
1026                 set_nport(&dest_lsa->u.sa, htons(1025));
1027                 /* dummy connect. makes kernel pick source IP (and port) */
1028                 xconnect(probe_fd, &dest_lsa->u.sa, dest_lsa->len);
1029                 set_nport(&dest_lsa->u.sa, htons(port));
1030
1031                 /* read IP and port */
1032                 source_lsa = get_sock_lsa(probe_fd);
1033                 if (source_lsa == NULL)
1034                         bb_error_msg_and_die("can't get probe addr");
1035
1036                 close(probe_fd);
1037
1038                 /* bind our sockets to this IP (but not port) */
1039                 set_nport(&source_lsa->u.sa, 0);
1040                 xbind(sndsock, &source_lsa->u.sa, source_lsa->len);
1041                 xbind(rcvsock, &source_lsa->u.sa, source_lsa->len);
1042
1043                 free(source_lsa);
1044         }
1045 #endif
1046
1047         /* Revert to non-privileged user after opening sockets */
1048         xsetgid(getgid());
1049         xsetuid(getuid());
1050
1051         dest_str = xmalloc_sockaddr2dotted_noport(&dest_lsa->u.sa);
1052         printf("traceroute to %s (%s)", argv[0], dest_str);
1053         if (ENABLE_FEATURE_CLEAN_UP) {
1054                 free(dest_str);
1055         }
1056
1057         if (op & OPT_SOURCE)
1058                 printf(" from %s", source);
1059         printf(", %d hops max, %d byte packets\n", max_ttl, packlen);
1060
1061         from_lsa = xmemdup(dest_lsa, LSA_LEN_SIZE + dest_lsa->len);
1062         lastaddr = xzalloc(dest_lsa->len);
1063         to = xzalloc(dest_lsa->len);
1064         seq = 0;
1065         for (ttl = first_ttl; ttl <= max_ttl; ++ttl) {
1066                 int probe;
1067                 int unreachable = 0; /* counter */
1068                 int gotlastaddr = 0; /* flags */
1069                 int got_there = 0;
1070
1071                 printf("%2d", ttl);
1072                 for (probe = 0; probe < nprobes; ++probe) {
1073                         int read_len;
1074                         unsigned t1;
1075                         unsigned t2;
1076                         int left_ms;
1077                         struct ip *ip;
1078
1079                         fflush_all();
1080                         if (probe != 0 && pausemsecs > 0)
1081                                 usleep(pausemsecs * 1000);
1082
1083                         send_probe(++seq, ttl);
1084                         t2 = t1 = monotonic_us();
1085
1086                         left_ms = waittime * 1000;
1087                         while ((read_len = wait_for_reply(from_lsa, to, &t2, &left_ms)) != 0) {
1088                                 int icmp_code;
1089
1090                                 /* Recv'ed a packet, or read error */
1091                                 /* t2 = monotonic_us() - set by wait_for_reply */
1092
1093                                 if (read_len < 0)
1094                                         continue;
1095                                 icmp_code = packet_ok(read_len, from_lsa, to, seq);
1096                                 /* Skip short packet */
1097                                 if (icmp_code == 0)
1098                                         continue;
1099
1100                                 if (!gotlastaddr
1101                                  || (memcmp(lastaddr, &from_lsa->u.sa, from_lsa->len) != 0)
1102                                 ) {
1103                                         print(read_len, &from_lsa->u.sa, to);
1104                                         memcpy(lastaddr, &from_lsa->u.sa, from_lsa->len);
1105                                         gotlastaddr = 1;
1106                                 }
1107
1108                                 print_delta_ms(t1, t2);
1109                                 ip = (struct ip *)recv_pkt;
1110
1111                                 if (from_lsa->u.sa.sa_family == AF_INET)
1112                                         if (op & OPT_TTL_FLAG)
1113                                                 printf(" (%d)", ip->ip_ttl);
1114
1115                                 /* time exceeded in transit */
1116                                 if (icmp_code == -1)
1117                                         break;
1118                                 icmp_code--;
1119                                 switch (icmp_code) {
1120 #if ENABLE_TRACEROUTE6
1121                                 case ICMP6_DST_UNREACH_NOPORT << 8:
1122                                         got_there = 1;
1123                                         break;
1124 #endif
1125                                 case ICMP_UNREACH_PORT:
1126                                         if (ip->ip_ttl <= 1)
1127                                                 printf(" !");
1128                                         got_there = 1;
1129                                         break;
1130
1131                                 case ICMP_UNREACH_NET:
1132 #if ENABLE_TRACEROUTE6 && (ICMP6_DST_UNREACH_NOROUTE != ICMP_UNREACH_NET)
1133                                 case ICMP6_DST_UNREACH_NOROUTE << 8:
1134 #endif
1135                                         printf(" !N");
1136                                         ++unreachable;
1137                                         break;
1138                                 case ICMP_UNREACH_HOST:
1139 #if ENABLE_TRACEROUTE6
1140                                 case ICMP6_DST_UNREACH_ADDR << 8:
1141 #endif
1142                                         printf(" !H");
1143                                         ++unreachable;
1144                                         break;
1145                                 case ICMP_UNREACH_PROTOCOL:
1146                                         printf(" !P");
1147                                         got_there = 1;
1148                                         break;
1149                                 case ICMP_UNREACH_NEEDFRAG:
1150                                         printf(" !F-%d", pmtu);
1151                                         ++unreachable;
1152                                         break;
1153                                 case ICMP_UNREACH_SRCFAIL:
1154 #if ENABLE_TRACEROUTE6
1155                                 case ICMP6_DST_UNREACH_ADMIN << 8:
1156 #endif
1157                                         printf(" !S");
1158                                         ++unreachable;
1159                                         break;
1160                                 case ICMP_UNREACH_FILTER_PROHIB:
1161                                 case ICMP_UNREACH_NET_PROHIB:   /* misuse */
1162                                         printf(" !A");
1163                                         ++unreachable;
1164                                         break;
1165                                 case ICMP_UNREACH_HOST_PROHIB:
1166                                         printf(" !C");
1167                                         ++unreachable;
1168                                         break;
1169                                 case ICMP_UNREACH_HOST_PRECEDENCE:
1170                                         printf(" !V");
1171                                         ++unreachable;
1172                                         break;
1173                                 case ICMP_UNREACH_PRECEDENCE_CUTOFF:
1174                                         printf(" !C");
1175                                         ++unreachable;
1176                                         break;
1177                                 case ICMP_UNREACH_NET_UNKNOWN:
1178                                 case ICMP_UNREACH_HOST_UNKNOWN:
1179                                         printf(" !U");
1180                                         ++unreachable;
1181                                         break;
1182                                 case ICMP_UNREACH_ISOLATED:
1183                                         printf(" !I");
1184                                         ++unreachable;
1185                                         break;
1186                                 case ICMP_UNREACH_TOSNET:
1187                                 case ICMP_UNREACH_TOSHOST:
1188                                         printf(" !T");
1189                                         ++unreachable;
1190                                         break;
1191                                 default:
1192                                         printf(" !<%d>", icmp_code);
1193                                         ++unreachable;
1194                                         break;
1195                                 }
1196                                 break;
1197                         } /* while (wait and read a packet) */
1198
1199                         /* there was no packet at all? */
1200                         if (read_len == 0)
1201                                 printf("  *");
1202                 } /* for (nprobes) */
1203
1204                 bb_putchar('\n');
1205                 if (got_there
1206                  || (unreachable > 0 && unreachable >= nprobes - 1)
1207                 ) {
1208                         break;
1209                 }
1210         }
1211
1212         if (ENABLE_FEATURE_CLEAN_UP) {
1213                 free(to);
1214                 free(lastaddr);
1215                 free(from_lsa);
1216         }
1217
1218         return 0;
1219 }
1220
1221 int traceroute_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
1222 int traceroute_main(int argc UNUSED_PARAM, char **argv)
1223 {
1224         return common_traceroute_main(0, argv);
1225 }
1226
1227 #if ENABLE_TRACEROUTE6
1228 int traceroute6_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
1229 int traceroute6_main(int argc UNUSED_PARAM, char **argv)
1230 {
1231         return common_traceroute_main(OPT_IPV6, argv);
1232 }
1233 #endif