calendar(1): Significant update to calendars from OpenBSD
[dragonfly.git] / usr.sbin / mrouted / mtrace.c
1 /*
2  * mtrace.c
3  *
4  * This tool traces the branch of a multicast tree from a source to a
5  * receiver for a particular multicast group and gives statistics
6  * about packet rate and loss for each hop along the path.  It can
7  * usually be invoked just as
8  *
9  *      mtrace source
10  *
11  * to trace the route from that source to the local host for a default
12  * group when only the route is desired and not group-specific packet
13  * counts.  See the usage line for more complex forms.
14  *
15  *
16  * Released 4 Apr 1995.  This program was adapted by Steve Casner
17  * (USC/ISI) from a prototype written by Ajit Thyagarajan (UDel and
18  * Xerox PARC).  It attempts to parallel in command syntax and output
19  * format the unicast traceroute program written by Van Jacobson (LBL)
20  * for the parts where that makes sense.
21  * 
22  * Copyright (c) 1995 by the University of Southern California
23  * All rights reserved.
24  *
25  * Permission to use, copy, modify, and distribute this software and its
26  * documentation in source and binary forms for any purposes and without
27  * fee is hereby granted, provided that the above copyright notice
28  * appear in all copies and that both the copyright notice and this
29  * permission notice appear in supporting documentation, and that any
30  * documentation, advertising materials, and other materials related to
31  * such distribution and use acknowledge that the software was developed
32  * by the University of Southern California, Information Sciences
33  * Institute.  The name of the University may not be used to endorse or
34  * promote products derived from this software without specific prior
35  * written permission.
36  *
37  * THE UNIVERSITY OF SOUTHERN CALIFORNIA makes no representations about
38  * the suitability of this software for any purpose.  THIS SOFTWARE IS
39  * PROVIDED "AS IS" AND WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES,
40  * INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
41  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
42  *
43  * Other copyrights might apply to parts of this software and are so
44  * noted when applicable.
45  *
46  * Parts of this software are derived from mrouted, which has the
47  * following license:
48  * 
49  * The mrouted program is covered by the following license.  Use of the
50  * mrouted program represents acceptance of these terms and conditions.
51  * 
52  * 1. STANFORD grants to LICENSEE a nonexclusive and nontransferable
53  * license to use, copy and modify the computer software ``mrouted''
54  * (hereinafter called the ``Program''), upon the terms and conditions
55  * hereinafter set out and until Licensee discontinues use of the Licensed
56  * Program.
57  * 
58  * 2. LICENSEE acknowledges that the Program is a research tool still in
59  * the development state, that it is being supplied ``as is,'' without any
60  * accompanying services from STANFORD, and that this license is entered
61  * into in order to encourage scientific collaboration aimed at further
62  * development and application of the Program.
63  * 
64  * 3. LICENSEE may copy the Program and may sublicense others to use
65  * object code copies of the Program or any derivative version of the
66  * Program.  All copies must contain all copyright and other proprietary
67  * notices found in the Program as provided by STANFORD.  Title to
68  * copyright to the Program remains with STANFORD.
69  * 
70  * 4. LICENSEE may create derivative versions of the Program.  LICENSEE
71  * hereby grants STANFORD a royalty-free license to use, copy, modify,
72  * distribute and sublicense any such derivative works.  At the time
73  * LICENSEE provides a copy of a derivative version of the Program to a
74  * third party, LICENSEE shall provide STANFORD with one copy of the
75  * source code of the derivative version at no charge to STANFORD.
76  * 
77  * 5. STANFORD MAKES NO REPRESENTATIONS OR WARRANTIES, EXPRESS OR
78  * IMPLIED.  By way of example, but not limitation, STANFORD MAKES NO
79  * REPRESENTATION OR WARRANTIES OF MERCHANTABILITY OR FITNESS FOR ANY
80  * PARTICULAR PURPOSE OR THAT THE USE OF THE LICENSED PROGRAM WILL NOT
81  * INFRINGE ANY PATENTS, COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS. STANFORD
82  * shall not be held liable for any liability nor for any direct, indirect
83  * or consequential damages with respect to any claim by LICENSEE or any
84  * third party on account of or arising from this Agreement or use of the
85  * Program.
86  * 
87  * 6. This agreement shall be construed, interpreted and applied in
88  * accordance with the State of California and any legal action arising
89  * out of this Agreement or use of the Program shall be filed in a court
90  * in the State of California.
91  * 
92  * 7. Nothing in this Agreement shall be construed as conferring rights to
93  * use in advertising, publicity or otherwise any trademark or the name
94  * of ``Stanford''.
95  * 
96  * The mrouted program is COPYRIGHT 1989 by The Board of Trustees of
97  * Leland Stanford Junior University.
98  *
99  *
100  * The mtrace program has been modified and improved by Xerox
101  * Corporation.  Xerox grants to LICENSEE a non-exclusive and
102  * non-transferable license to use, copy, and modify the Xerox modified
103  * and improved mrouted software on the same terms and conditions which
104  * govern the license Stanford and ISI grant with respect to the mtrace
105  * program.  These terms and conditions are incorporated in this grant
106  * by reference and shall be deemed to have been accepted by LICENSEE
107  * to cover its relationship with Xerox Corporation with respect to any
108  * use of the Xerox improved program.
109  * 
110  * The mtrace program is COPYRIGHT 1998 by Xerox Corporation.
111  *
112  * $FreeBSD: src/usr.sbin/mrouted/mtrace.c,v 1.17.2.3 2002/09/12 16:27:49 nectar Exp $
113  */
114
115 #include <ctype.h>
116 #include <err.h>
117 #include <errno.h>
118 #include <memory.h>
119 #include <netdb.h>
120 #include <stdio.h>
121 #include <stdlib.h>
122 #include <string.h>
123 #include <syslog.h>
124 #include <unistd.h>
125 #include <sys/param.h>
126 #include <sys/types.h>
127 #include <sys/socket.h>
128 #include <sys/time.h>
129 #include <net/if.h>
130 #include <netinet/in.h>
131 #include <netinet/in_systm.h>
132 #include <netinet/ip.h>
133 #include <netinet/igmp.h>
134 #include <sys/ioctl.h>
135 #ifdef SYSV
136 #include <sys/sockio.h>
137 #endif
138 #include <arpa/inet.h>
139 #include <stdarg.h>
140 #ifdef SUNOS5
141 #include <sys/systeminfo.h>
142 #endif
143
144 typedef unsigned int u_int32;   /* XXX */
145 #include "mtrace.h"
146
147 #define DEFAULT_TIMEOUT 3       /* How long to wait before retrying requests */
148 #define DEFAULT_RETRIES 3       /* How many times to try */
149 #define DEFAULT_EXTRAHOPS 3     /* How many hops past a non-responding rtr */
150 #define MAXHOPS 60              /* Don't need more hops than this */
151 #define UNICAST_TTL 255         /* TTL for unicast response */
152 #define MULTICAST_TTL1 127      /* Default TTL for multicast query/response */
153 #define MULTICAST_TTL_INC 32    /* TTL increment for increase after timeout */
154 #define MULTICAST_TTL_MAX 192   /* Maximum TTL allowed (protect low-BW links */
155
156 #define TRUE 1
157 #define FALSE 0
158 #define DVMRP_ASK_NEIGHBORS2    5       /* DVMRP msg requesting neighbors */
159 #define DVMRP_NEIGHBORS2        6       /* reply to above */
160 #define DVMRP_NF_DOWN           0x10    /* kernel state of interface */
161 #define DVMRP_NF_DISABLED       0x20    /* administratively disabled */
162 #define MAX_IP_PACKET_LEN       576
163 #define MIN_IP_HEADER_LEN       20
164 #define MAX_IP_HEADER_LEN       60
165 #define MAX_DVMRP_DATA_LEN \
166                 ( MAX_IP_PACKET_LEN - MAX_IP_HEADER_LEN - IGMP_MINLEN )
167
168 struct resp_buf {
169     u_long qtime;               /* Time query was issued */
170     u_long rtime;               /* Time response was received */
171     int len;                    /* Number of reports or length of data */
172     struct igmp igmp;           /* IGMP header */
173     union {
174         struct {
175             struct tr_query q;          /* Query/response header */
176             struct tr_resp r[MAXHOPS];  /* Per-hop reports */
177         } t;
178         char d[MAX_DVMRP_DATA_LEN];     /* Neighbor data */
179     } u;
180 } base, incr[2];
181
182 #define qhdr u.t.q
183 #define resps u.t.r
184 #define ndata u.d
185
186 char *names[MAXHOPS];
187
188 /*
189  * In mrouted 3.3 and 3.4 (and in some Cisco IOS releases),
190  * cache entries can get deleted even if there is traffic
191  * flowing, which will reset the per-source/group counters.
192  */
193 #define         BUG_RESET       0x01
194
195 /*
196  * Also in mrouted 3.3 and 3.4, there's a bug in neighbor
197  * version processing which can cause them to believe that
198  * the neighbor is constantly resetting.  This causes them
199  * to constantly delete all their state.
200  */
201 #define         BUG_RESET2X     0x02
202
203 /*
204  * Pre-3.7 mrouted's forget to byte-swap their reports.
205  */
206 #define         BUG_SWAP        0x04
207
208 /*
209  * Pre-3.9 mrouted's forgot a parenthesis in the htonl()
210  * on the time calculation so supply bogus times.
211  */
212 #define         BUG_BOGUSTIME   0x08
213
214 #define BUG_NOPRINT     (BUG_RESET | BUG_RESET2X)
215
216 int bugs[MAXHOPS];                      /* List of bugs noticed at each hop */
217
218 struct mtrace {
219         struct mtrace   *next;
220         struct resp_buf  base, incr[2];
221         struct resp_buf *new, *prev;
222         int              nresp;
223         struct timeval   last;
224         int              bugs[MAXHOPS];
225         char            *names[MAXHOPS];
226         int              lastqid;
227 };
228
229 int timeout = DEFAULT_TIMEOUT;
230 int nqueries = DEFAULT_RETRIES;
231 int numeric = FALSE;
232 int debug = 0;
233 int passive = FALSE;
234 int multicast = FALSE;
235 int unicast = FALSE;
236 int statint = 10;
237 int verbose = FALSE;
238 int tunstats = FALSE;
239 int weak = FALSE;
240 int extrahops = DEFAULT_EXTRAHOPS;
241 int printstats = TRUE;
242 int sendopts = TRUE;
243 int lossthresh = 0;
244 int fflag = FALSE;
245 int staticqid = 0;
246
247 u_int32 defgrp;                         /* Default group if not specified */
248 u_int32 query_cast;                     /* All routers multicast addr */
249 u_int32 resp_cast;                      /* Mtrace response multicast addr */
250
251 u_int32 lcl_addr = 0;                   /* This host address, in NET order */
252 u_int32 dst_netmask = 0;                /* netmask to go with qdst */
253
254 /*
255  * Query/response parameters, all initialized to zero and set later
256  * to default values or from options.
257  */
258 u_int32 qsrc = 0;               /* Source address in the query */
259 u_int32 qgrp = 0;               /* Group address in the query */
260 u_int32 qdst = 0;               /* Destination (receiver) address in query */
261 u_char qno  = 0;                /* Max number of hops to query */
262 u_int32 raddr = 0;              /* Address where response should be sent */
263 int    qttl = 0;                /* TTL for the query packet */
264 u_char rttl = 0;                /* TTL for the response packet */
265 u_int32 gwy = 0;                /* User-supplied last-hop router address */
266 u_int32 tdst = 0;               /* Address where trace is sent (last-hop) */
267
268 char s1[19];            /* buffers to hold the string representations  */
269 char s2[19];            /* of IP addresses, to be passed to inet_fmt() */
270 char s3[19];            /* or inet_fmts().                             */
271
272 #if !(defined(BSD) && (BSD >= 199103))
273 extern int              errno;
274 extern int              sys_nerr;
275 extern char *           sys_errlist[];
276 #endif
277
278 #define RECV_BUF_SIZE 8192
279 char    *send_buf, *recv_buf;
280 int     igmp_socket;
281 u_int32 allrtrs_group;
282 char    router_alert[4];                /* Router Alert IP Option           */
283 #ifndef IPOPT_RA
284 #define IPOPT_RA                148
285 #endif
286 #ifdef SUNOS5
287 char    eol[4];                         /* EOL IP Option                    */
288 int ip_addlen = 0;                      /* Workaround for Option bug #2     */
289 #endif
290
291 /*
292  * max macro, with weird case to avoid conflicts
293  */
294 #define MaX(a,b)        ((a) > (b) ? (a) : (b))
295
296 typedef int (*callback_t)(int, u_char *, int, struct igmp *, int,
297                         struct sockaddr *, int *, struct timeval *);
298
299 void                    init_igmp(void);
300 void                    send_igmp(u_int32 src, u_int32 dst, int type,
301                                                 int code, u_int32 group,
302                                                 int datalen);
303 int                     inet_cksum(u_short *addr, u_int len);
304 void                    k_set_rcvbuf(int bufsize);
305 void                    k_hdr_include(int boolv);
306 void                    k_set_ttl(int t);
307 void                    k_set_loop(int l);
308 void                    k_set_if(u_int32 ifa);
309 void                    k_join(u_int32 grp, u_int32 ifa);
310 void                    k_leave(u_int32 grp, u_int32 ifa);
311 char *                  inet_fmt(u_int32 addr, char *s);
312 char *                  inet_fmts(u_int32 addr, u_int32 mask, char *s);
313 char *                  inet_name(u_int32 addr);
314 u_int32                 host_addr(char *name);
315 /* u_int is promoted u_char */
316 char *                  proto_type(u_int type);
317 char *                  flag_type(u_int type);
318
319 u_int32                 get_netmask(int s, u_int32 *dst);
320 int                     get_ttl(struct resp_buf *buf);
321 int                     t_diff(u_long a, u_long b);
322 u_long                  byteswap(u_long v);
323 int                     mtrace_callback(int, u_char *, int, struct igmp *,
324                                         int, struct sockaddr *, int *,
325                                         struct timeval *);
326 int                     send_recv(u_int32 dst, int type, int code,
327                                         int tries, struct resp_buf *save,
328                                         callback_t callback);
329 void                    passive_mode(void) __dead2;
330 char *                  print_host(u_int32 addr);
331 char *                  print_host2(u_int32 addr1, u_int32 addr2);
332 void                    print_trace(int idx, struct resp_buf *buf,
333                                         char **names);
334 int                     what_kind(struct resp_buf *buf, char *why);
335 char *                  scale(int *hop);
336 void                    stat_line(struct tr_resp *r, struct tr_resp *s,
337                                         int have_next, int *res);
338 void                    fixup_stats(struct resp_buf *base,
339                                         struct resp_buf *prev,
340                                         struct resp_buf *new,
341                                         int *bugs);
342 int                     check_thresh(int thresh,
343                                         struct resp_buf *base,
344                                         struct resp_buf *prev,
345                                         struct resp_buf *new);
346 int                     print_stats(struct resp_buf *base,
347                                         struct resp_buf *prev,
348                                         struct resp_buf *new,
349                                         int *bugs,
350                                         char **names);
351 int                     path_changed(struct resp_buf *base,
352                                         struct resp_buf *new);
353 void                    check_vif_state(void);
354
355 void                    dolog(int, int, char *, ...) __printflike(3, 4);
356 static void             usage(void);
357
358
359 /*
360  * Open and initialize the igmp socket, and fill in the non-changing
361  * IP header fields in the output packet buffer.
362  */
363 void
364 init_igmp(void)
365 {
366     struct ip *ip;
367
368     recv_buf = (char *)malloc(RECV_BUF_SIZE);
369     if (recv_buf == NULL)
370         dolog(LOG_ERR, 0, "Out of memory allocating recv_buf!");
371     send_buf = (char *)malloc(RECV_BUF_SIZE);
372     if (send_buf == NULL)
373         dolog(LOG_ERR, 0, "Out of memory allocating send_buf!");
374
375     if ((igmp_socket = socket(AF_INET, SOCK_RAW, IPPROTO_IGMP)) < 0) 
376         dolog(LOG_ERR, errno, "IGMP socket");
377
378     k_hdr_include(TRUE);        /* include IP header when sending */
379     k_set_rcvbuf(48*1024);      /* lots of input buffering        */
380     k_set_ttl(1);               /* restrict multicasts to one hop */
381     k_set_loop(FALSE);          /* disable multicast loopback     */
382
383     ip         = (struct ip *)send_buf;
384     ip->ip_hl  = sizeof(struct ip) >> 2;
385     ip->ip_v   = IPVERSION;
386     ip->ip_tos = 0;
387     ip->ip_off = 0;
388     ip->ip_p   = IPPROTO_IGMP;
389     ip->ip_ttl = MAXTTL;        /* applies to unicasts only */
390
391 #ifndef INADDR_ALLRTRS_GROUP
392 #define INADDR_ALLRTRS_GROUP    0xe0000002      /* 224.0.0.2 */
393 #endif
394     allrtrs_group  = htonl(INADDR_ALLRTRS_GROUP);
395
396     router_alert[0] = IPOPT_RA; /* Router Alert */
397     router_alert[1] = 4;        /* 4 bytes */
398     router_alert[2] = 0;
399     router_alert[3] = 0;
400 }
401
402 #ifdef SUNOS5
403 void
404 checkforsolarisbug(void)
405 {
406     u_int32 localhost = htonl(0x7f000001);
407
408     eol[0] = IPOPT_EOL;
409     eol[1] = IPOPT_EOL;
410     eol[2] = IPOPT_EOL;
411     eol[3] = IPOPT_EOL;
412
413     setsockopt(igmp_socket, IPPROTO_IP, IP_OPTIONS, eol, sizeof(eol));
414     /*
415      * Check if the kernel adds the options length to the packet
416      * length.  Send myself an IGMP packet of type 0 (illegal),
417      * with 4 IPOPT_EOL options, my PID (for collision detection)
418      * and 4 bytes of zero (so that the checksum works whether
419      * the 4 bytes of zero get truncated or not).
420      */
421     bzero(send_buf + MIN_IP_HEADER_LEN + IGMP_MINLEN, 8);
422     *(int *)(send_buf + MIN_IP_HEADER_LEN + IGMP_MINLEN) = getpid();
423     send_igmp(localhost, localhost, 0, 0, 0, 8);
424     while (1) {
425         int recvlen, dummy = 0;
426
427         recvlen = recvfrom(igmp_socket, recv_buf, RECV_BUF_SIZE,
428                                 0, NULL, &dummy);
429         /* 8 == 4 bytes of options and 4 bytes of PID */
430         if (recvlen >= MIN_IP_HEADER_LEN + IGMP_MINLEN + 8) {
431             struct ip *ip = (struct ip *)recv_buf;
432             struct igmp *igmp;
433             int *p;
434
435             if (ip->ip_hl != 6 ||
436                 ip->ip_p != IPPROTO_IGMP ||
437                 ip->ip_src.s_addr != localhost ||
438                 ip->ip_dst.s_addr != localhost)
439                 continue;
440
441             igmp = (struct igmp *)(recv_buf + (ip->ip_hl << 2));
442             if (igmp->igmp_group.s_addr != 0)
443                 continue;
444             if (igmp->igmp_type != 0 || igmp->igmp_code != 0)
445                 continue;
446
447             p = (int *)((char *)igmp + IGMP_MINLEN);
448             if (*p != getpid())
449                 continue;
450
451 #ifdef RAW_INPUT_IS_RAW
452             ip->ip_len = ntohs(ip->ip_len);
453 #endif
454             if (ip->ip_len == IGMP_MINLEN + 4)
455                 ip_addlen = 4;
456             else if (ip->ip_len == IGMP_MINLEN + 8)
457                 ip_addlen = 0;
458             else
459                 dolog(LOG_ERR, 0, "while checking for Solaris bug: Sent %d bytes and got back %d!", IGMP_MINLEN + 8, ip->ip_len);
460
461             break;
462         }
463     }
464 }
465 #endif
466
467 /*
468  * Construct an IGMP message in the output packet buffer.  The caller may
469  * have already placed data in that buffer, of length 'datalen'.  Then send
470  * the message from the interface with IP address 'src' to destination 'dst'.
471  */
472 void
473 send_igmp(u_int32 src, u_int32 dst, int type, int code, u_int32 group,
474           int datalen)
475 {
476     struct sockaddr_in sdst;
477     struct ip *ip;
478     struct igmp *igmp;
479     int setloop = 0;
480     static int raset = 0;
481     int sendra = 0;
482     int sendlen;
483
484     ip                      = (struct ip *)send_buf;
485     ip->ip_src.s_addr       = src;
486     ip->ip_dst.s_addr       = dst;
487     ip->ip_len              = MIN_IP_HEADER_LEN + IGMP_MINLEN + datalen;
488     sendlen                 = ip->ip_len;
489 #ifdef SUNOS5
490     ip->ip_len             += ip_addlen;
491 #endif
492 #ifdef RAW_OUTPUT_IS_RAW
493     ip->ip_len              = htons(ip->ip_len);
494 #endif
495
496     igmp                    = (struct igmp *)(send_buf + MIN_IP_HEADER_LEN);
497     igmp->igmp_type         = type;
498     igmp->igmp_code         = code;
499     igmp->igmp_group.s_addr = group;
500     igmp->igmp_cksum        = 0;
501     igmp->igmp_cksum        = inet_cksum((u_short *)igmp,
502                                          IGMP_MINLEN + datalen);
503
504     if (IN_MULTICAST(ntohl(dst))) {
505         k_set_if(src);
506         setloop = 1;
507         k_set_loop(TRUE);
508         if (dst != allrtrs_group)
509             sendra = 1;
510     }
511
512     if (sendopts && sendra && !raset) {
513         setsockopt(igmp_socket, IPPROTO_IP, IP_OPTIONS,
514                         router_alert, sizeof(router_alert));
515         raset = 1;
516     } else if (!sendra && raset) {
517 #ifdef SUNOS5
518         /*
519          * SunOS5 < 5.6 cannot properly reset the IP_OPTIONS "socket"
520          * option.  Instead, set up a string of 4 EOL's.
521          */
522         setsockopt(igmp_socket, IPPROTO_IP, IP_OPTIONS,
523                         eol, sizeof(eol));
524 #else
525         setsockopt(igmp_socket, IPPROTO_IP, IP_OPTIONS,
526                         NULL, 0);
527 #endif
528         raset = 0;
529     }
530
531     bzero(&sdst, sizeof(sdst));
532     sdst.sin_family = AF_INET;
533 #if (defined(BSD) && (BSD >= 199103))
534     sdst.sin_len = sizeof(sdst);
535 #endif
536     sdst.sin_addr.s_addr = dst;
537     if (sendto(igmp_socket, send_buf, sendlen, 0,
538                         (struct sockaddr *)&sdst, sizeof(sdst)) < 0) {
539             dolog(LOG_WARNING, errno, "sendto to %s on %s",
540                 inet_fmt(dst, s1), inet_fmt(src, s2));
541     }
542
543     if (setloop)
544             k_set_loop(FALSE);
545
546     dolog(LOG_DEBUG, 0, "SENT %s from %-15s to %s",
547         type == IGMP_MTRACE ? "mtrace request" : "ask_neighbors",
548         src == INADDR_ANY ? "INADDR_ANY" : inet_fmt(src, s1),
549         inet_fmt(dst, s2));
550 }
551
552 /*
553  * inet_cksum extracted from:
554  *                      P I N G . C
555  *
556  * Author -
557  *      Mike Muuss
558  *      U. S. Army Ballistic Research Laboratory
559  *      December, 1983
560  * Modified at Uc Berkeley
561  *
562  * (ping.c) Status -
563  *      Public Domain.  Distribution Unlimited.
564  *
565  *                      I N _ C K S U M
566  *
567  * Checksum routine for Internet Protocol family headers (C Version)
568  *
569  */
570 int
571 inet_cksum(u_short *addr, u_int len)
572 {
573         int nleft = (int)len;
574         u_short *w = addr;
575         u_short answer = 0;
576         int sum = 0;
577
578         /*
579          *  Our algorithm is simple, using a 32 bit accumulator (sum),
580          *  we add sequential 16 bit words to it, and at the end, fold
581          *  back all the carry bits from the top 16 bits into the lower
582          *  16 bits.
583          */
584         while (nleft > 1)  {
585                 sum += *w++;
586                 nleft -= 2;
587         }
588
589         /* mop up an odd byte, if necessary */
590         if (nleft == 1) {
591                 *(u_char *) (&answer) = *(u_char *)w ;
592                 sum += answer;
593         }
594
595         /*
596          * add back carry outs from top 16 bits to low 16 bits
597          */
598         sum = (sum >> 16) + (sum & 0xffff);     /* add hi 16 to low 16 */
599         sum += (sum >> 16);                     /* add carry */
600         answer = ~sum;                          /* truncate to 16 bits */
601         return (answer);
602 }
603
604 void
605 k_set_rcvbuf(int bufsize)
606 {
607     if (setsockopt(igmp_socket, SOL_SOCKET, SO_RCVBUF,
608                    (char *)&bufsize, sizeof(bufsize)) < 0)
609         dolog(LOG_ERR, errno, "setsockopt SO_RCVBUF %u", bufsize);
610 }
611
612
613 void
614 k_hdr_include(int boolv)
615 {
616 #ifdef IP_HDRINCL
617     if (setsockopt(igmp_socket, IPPROTO_IP, IP_HDRINCL,
618                    (char *)&boolv, sizeof(boolv)) < 0)
619         dolog(LOG_ERR, errno, "setsockopt IP_HDRINCL %u", boolv);
620 #endif
621 }
622
623 void
624 k_set_ttl(int t)
625 {
626     u_char ttl;
627
628     ttl = t;
629     if (setsockopt(igmp_socket, IPPROTO_IP, IP_MULTICAST_TTL,
630                    (char *)&ttl, sizeof(ttl)) < 0)
631         dolog(LOG_ERR, errno, "setsockopt IP_MULTICAST_TTL %u", ttl);
632 }
633
634
635 void
636 k_set_loop(int l)
637 {
638     u_char loop;
639
640     loop = l;
641     if (setsockopt(igmp_socket, IPPROTO_IP, IP_MULTICAST_LOOP,
642                    (char *)&loop, sizeof(loop)) < 0)
643         dolog(LOG_ERR, errno, "setsockopt IP_MULTICAST_LOOP %u", loop);
644 }
645
646 void
647 k_set_if(u_int32 ifa)
648 {
649     struct in_addr adr;
650
651     adr.s_addr = ifa;
652     if (setsockopt(igmp_socket, IPPROTO_IP, IP_MULTICAST_IF,
653                    (char *)&adr, sizeof(adr)) < 0)
654         dolog(LOG_ERR, errno, "setsockopt IP_MULTICAST_IF %s",
655                             inet_fmt(ifa, s1));
656 }
657
658 void
659 k_join(u_int32 grp, u_int32 ifa)
660 {
661     struct ip_mreq mreq;
662
663     mreq.imr_multiaddr.s_addr = grp;
664     mreq.imr_interface.s_addr = ifa;
665
666     if (setsockopt(igmp_socket, IPPROTO_IP, IP_ADD_MEMBERSHIP,
667                    (char *)&mreq, sizeof(mreq)) < 0)
668         dolog(LOG_WARNING, errno, "can't join group %s on interface %s",
669                                 inet_fmt(grp, s1), inet_fmt(ifa, s2));
670 }
671
672
673 void
674 k_leave(u_int32 grp, u_int32 ifa)
675 {
676     struct ip_mreq mreq;
677
678     mreq.imr_multiaddr.s_addr = grp;
679     mreq.imr_interface.s_addr = ifa;
680
681     if (setsockopt(igmp_socket, IPPROTO_IP, IP_DROP_MEMBERSHIP,
682                    (char *)&mreq, sizeof(mreq)) < 0)
683         dolog(LOG_WARNING, errno, "can't leave group %s on interface %s",
684                                 inet_fmt(grp, s1), inet_fmt(ifa, s2));
685 }
686
687 /*
688  * Convert an IP address in u_long (network) format into a printable string.
689  */
690 char *
691 inet_fmt(u_int32 addr, char *s)
692 {
693     u_char *a;
694
695     a = (u_char *)&addr;
696     sprintf(s, "%u.%u.%u.%u", a[0], a[1], a[2], a[3]);
697     return (s);
698 }
699
700
701 /*
702  * Convert an IP subnet number in u_long (network) format into a printable
703  * string including the netmask as a number of bits.
704  */
705 char *
706 inet_fmts(u_int32 addr, u_int32 mask, char *s)
707 {
708     u_char *a, *m;
709     int bits;
710
711     if ((addr == 0) && (mask == 0)) {
712         sprintf(s, "default");
713         return (s);
714     }
715     a = (u_char *)&addr;
716     m = (u_char *)&mask;
717     bits = 33 - ffs(ntohl(mask));
718
719     if      (m[3] != 0) sprintf(s, "%u.%u.%u.%u/%d", a[0], a[1], a[2], a[3],
720                                                 bits);
721     else if (m[2] != 0) sprintf(s, "%u.%u.%u/%d",    a[0], a[1], a[2], bits);
722     else if (m[1] != 0) sprintf(s, "%u.%u/%d",       a[0], a[1], bits);
723     else                sprintf(s, "%u/%d",          a[0], bits);
724
725     return (s);
726 }
727
728 char *
729 inet_name(u_int32 addr)
730 {
731     struct hostent *e;
732
733     e = gethostbyaddr(&addr, sizeof(addr), AF_INET);
734
735     return e ? e->h_name : "?";
736 }
737
738
739 u_int32 
740 host_addr(char *name)
741 {
742     struct hostent *e = NULL;
743     u_int32  addr;
744     int i, dots = 3;
745     char        buf[40];
746     char        *ip = name;
747     char        *op = buf;
748
749     /*
750      * Undo BSD's favor -- take fewer than 4 octets as net/subnet address
751      * if the name is all numeric.
752      */
753     for (i = sizeof(buf) - 7; i > 0; --i) {
754         if (*ip == '.') --dots;
755         else if (*ip == '\0') break;
756         else if (!isdigit(*ip)) dots = 0;  /* Not numeric, don't add zeroes */
757         *op++ = *ip++;
758     }
759     for (i = 0; i < dots; ++i) {
760         *op++ = '.';
761         *op++ = '0';
762     }
763     *op = '\0';
764
765     if (dots <= 0)
766         e = gethostbyname(name);
767     if (e && (e->h_length == sizeof(addr))) {
768         memcpy((char *)&addr, e->h_addr_list[0], e->h_length);
769         if (e->h_addr_list[1])
770             fprintf(stderr, "Warning: %s has multiple addresses, using %s\n",
771                         name, inet_fmt(addr, s1));
772     } else {
773         addr = inet_addr(buf);
774         if (addr == -1 || (IN_MULTICAST(addr) && dots)) {
775             addr = 0;
776             printf("Could not parse %s as host name or address\n", name);
777         }
778     }
779     return addr;
780 }
781
782
783 char *
784 proto_type(u_int type)
785 {
786     static char buf[80];
787
788     switch (type) {
789       case PROTO_DVMRP:
790         return ("DVMRP");
791       case PROTO_MOSPF:
792         return ("MOSPF");
793       case PROTO_PIM:
794         return ("PIM");
795       case PROTO_CBT:
796         return ("CBT");
797       case PROTO_PIM_SPECIAL:
798         return ("PIM/Special");
799       case PROTO_PIM_STATIC:
800         return ("PIM/Static");
801       case PROTO_DVMRP_STATIC:
802         return ("DVMRP/Static");
803       case PROTO_PIM_BGP4PLUS:
804         return ("PIM/BGP4+");
805       case PROTO_CBT_SPECIAL:
806         return ("CBT/Special");
807       case PROTO_CBT_STATIC:
808         return ("CBT/Static");
809       case PROTO_PIM_ASSERT:
810         return ("PIM/Assert");
811       case 0:
812         return ("None");
813       default:
814         sprintf(buf, "Unknown protocol code %d", type);
815         return (buf);
816     }
817 }
818
819
820 char *
821 flag_type(u_int type)
822 {
823     static char buf[80];
824
825     switch (type) {
826       case TR_NO_ERR:
827         return ("");
828       case TR_WRONG_IF:
829         return ("Wrong interface");
830       case TR_PRUNED:
831         return ("Prune sent upstream");
832       case TR_OPRUNED:
833         return ("Output pruned");
834       case TR_SCOPED:
835         return ("Hit scope boundary");
836       case TR_NO_RTE:
837         return ("No route");
838       case TR_NO_FWD:
839         return ("Not forwarding");
840       case TR_HIT_RP:
841         return ("Reached RP/Core");
842       case TR_RPF_IF:
843         return ("RPF Interface");
844       case TR_NO_MULTI:
845         return ("Multicast disabled");
846       case TR_OLD_ROUTER:
847         return ("Next router no mtrace");
848       case TR_NO_SPACE:
849         return ("No space in packet");
850       case TR_ADMIN_PROHIB:
851         return ("Admin. Prohibited");
852       default:
853         sprintf(buf, "Unknown error code %d", type);
854         return (buf);
855     }
856 }    
857
858 /*
859  * If destination is on a local net, get the netmask, else set the
860  * netmask to all ones.  There are two side effects: if the local
861  * address was not explicitly set, and if the destination is on a
862  * local net, use that one; in either case, verify that the local
863  * address is valid.
864  */
865 u_int32
866 get_netmask(int s, u_int32 *dst)
867 {
868     unsigned int n;
869     struct ifconf ifc;
870     struct ifreq *ifrp, *ifend;
871     u_int32 if_addr, if_mask;
872     u_int32 retval = 0xFFFFFFFF;
873     int found = FALSE;
874     int num_ifreq = 32;
875
876     ifc.ifc_len = num_ifreq * sizeof(struct ifreq);
877     ifc.ifc_buf = malloc(ifc.ifc_len);
878     while (ifc.ifc_buf) {
879         if (ioctl(s, SIOCGIFCONF, (char *)&ifc) < 0) {
880             perror("ioctl SIOCGIFCONF");
881             return retval;
882         }
883
884         /*
885          * If the buffer was large enough to hold all the addresses
886          * then break out, otherwise increase the buffer size and
887          * try again.
888          *
889          * The only way to know that we definitely had enough space
890          * is to know that there was enough space for at least one
891          * more struct ifreq. ???
892          */
893         if ((num_ifreq * sizeof(struct ifreq)) >=
894              ifc.ifc_len + sizeof(struct ifreq))
895              break;
896
897         num_ifreq *= 2;
898         ifc.ifc_len = num_ifreq * sizeof(struct ifreq);
899         ifc.ifc_buf = realloc(ifc.ifc_buf, ifc.ifc_len);
900     }
901     if (ifc.ifc_buf == NULL) {
902         fprintf(stderr, "getting interface list: ran out of memory");
903         exit(1);
904     }
905
906     ifrp = (struct ifreq *)ifc.ifc_buf;
907     ifend = (struct ifreq *)(ifc.ifc_buf + ifc.ifc_len);
908     /*
909      * Loop through all of the interfaces.
910      */
911     for (; ifrp < ifend && !found; ifrp = (struct ifreq *)((char *)ifrp + n)) {
912 #if BSD >= 199006
913         n = ifrp->ifr_addr.sa_len + sizeof(ifrp->ifr_name);
914         if (n < sizeof(*ifrp))
915             n = sizeof(*ifrp);
916 #else
917         n = sizeof(*ifrp);
918 #endif
919         /*
920          * Ignore any interface for an address family other than IP.
921          */
922         if (ifrp->ifr_addr.sa_family != AF_INET)
923             continue;
924
925         if_addr = ((struct sockaddr_in *)&(ifrp->ifr_addr))->sin_addr.s_addr;
926         if (ioctl(s, SIOCGIFFLAGS, (char *)ifrp) < 0) {
927             fprintf(stderr, "SIOCGIFFLAGS on ");
928             perror(ifrp->ifr_name);
929             continue;
930         }
931         if ((ifrp->ifr_flags & (IFF_MULTICAST|IFF_UP|IFF_LOOPBACK)) !=
932                                 (IFF_MULTICAST|IFF_UP))
933             continue;
934         if (*dst == 0)
935             *dst = if_addr;
936         if (ioctl(s, SIOCGIFNETMASK, (char *)ifrp) >= 0) {
937             if_mask = ((struct sockaddr_in *)&(ifrp->ifr_addr))->sin_addr.s_addr;
938             if (if_mask != 0 && (*dst & if_mask) == (if_addr & if_mask)) {
939                 retval = if_mask;
940                 if (lcl_addr == 0) lcl_addr = if_addr;  /* XXX what about aliases? */
941             }
942         }
943         if (lcl_addr == if_addr) found = TRUE;
944     }
945     if (!found && lcl_addr != 0) {
946         printf("Interface address is not valid\n");
947         exit(1);
948     }
949     return (retval);
950 }
951
952
953 /*
954  * Try to pick a TTL that will get past all the thresholds in the path.
955  */
956 int
957 get_ttl(struct resp_buf *buf)
958 {
959     int rno;
960     struct tr_resp *b;
961     u_int ttl;
962
963     if (buf && (rno = buf->len) > 0) {
964         b = buf->resps + rno - 1;
965         ttl = b->tr_fttl;
966
967         while (--rno > 0) {
968             --b;
969             if (ttl < b->tr_fttl) ttl = b->tr_fttl;
970             else ++ttl;
971         }
972         ttl += MULTICAST_TTL_INC;
973         if (ttl < MULTICAST_TTL1) ttl = MULTICAST_TTL1;
974         if (ttl > MULTICAST_TTL_MAX) ttl = MULTICAST_TTL_MAX;
975         return (ttl);
976     } else return(MULTICAST_TTL1);
977 }
978
979 /*
980  * Calculate the difference between two 32-bit NTP timestamps and return
981  * the result in milliseconds.
982  */
983 int
984 t_diff(u_long a, u_long b)
985 {
986     int d = a - b;
987
988     return ((d * 125) >> 13);
989 }
990
991 /*
992  * Swap bytes for poor little-endian machines that don't byte-swap
993  */
994 u_long
995 byteswap(u_long v)
996 {
997     return ((v << 24) | ((v & 0xff00) << 8) |
998             ((v >> 8) & 0xff00) | (v >> 24));
999 }
1000
1001 #if 0
1002 /*
1003  * XXX incomplete - need private callback data, too?
1004  * XXX since dst doesn't get passed through?
1005  */
1006 int
1007 neighbors_callback(int tmo, u_char *buf, int buflen, struct igmp *igmp,
1008                    int igmplen, struct sockaddr *addr, int *addrlen,
1009                    struct timeval *ts)
1010 {
1011     int len;
1012     u_int32 dst;
1013     struct ip *ip = (struct ip *)buf;
1014
1015     if (tmo)
1016         return 0;
1017
1018     if (igmp->igmp_code != DVMRP_NEIGHBORS2)
1019         return 0;
1020     len = igmplen;
1021     /*
1022      * Accept DVMRP_NEIGHBORS2 response if it comes from the
1023      * address queried or if that address is one of the local
1024      * addresses in the response.
1025      */
1026     if (ip->ip_src.s_addr != dst) {
1027         u_int32 *p = (u_int32 *)(igmp + 1);
1028         u_int32 *ep = p + (len >> 2);
1029         while (p < ep) {
1030             u_int32 laddr = *p++;
1031             int n = ntohl(*p++) & 0xFF;
1032             if (laddr == dst) {
1033                 ep = p + 1;             /* ensure p < ep after loop */
1034                 break;
1035             }
1036             p += n;
1037         }
1038         if (p >= ep)
1039             return 0;
1040     }
1041     return buflen;
1042 }
1043 #endif
1044
1045 int
1046 mtrace_callback(int tmo, u_char *buf, int buflen, struct igmp *igmp,
1047                 int igmplen, struct sockaddr *addr, int *addrlen,
1048                 struct timeval *ts)
1049 {
1050     static u_char *savbuf = NULL;
1051     static int savbuflen;
1052     static struct sockaddr *savaddr;
1053     static int savaddrlen;
1054     static struct timeval savts;
1055
1056     int len = (igmplen - QLEN) / RLEN;
1057     struct tr_resp *r = (struct tr_resp *)((struct tr_query *)(igmp + 1) + 1);
1058
1059     if (tmo == 1) {
1060         /*
1061          * If we timed out with a packet saved, then return that packet.
1062          * send_recv won't send this same packet to the callback again.
1063          */
1064         if (savbuf) {
1065             bcopy(savbuf, buf, savbuflen);
1066             free(savbuf);
1067             savbuf = NULL;
1068             bcopy(savaddr, addr, savaddrlen);
1069             free(savaddr);
1070             *addrlen = savaddrlen;
1071             bcopy(&savts, ts, sizeof(savts));
1072             return savbuflen;
1073         }
1074         return 0;
1075     }
1076     if (savbuf) {
1077         free(savbuf);
1078         savbuf = NULL;
1079         free(savaddr);
1080     }
1081     /*
1082      * Check for IOS bug described in CSCdi68628, where a router that does
1083      *  not have multicast enabled responds to an mtrace request with a 1-hop
1084      *  error packet.
1085      * Heuristic is:
1086      *  If there is only one hop reported in the packet,
1087      *  And the protocol code is 0,
1088      *  And there is no previous hop,
1089      *  And the forwarding information is "Not Forwarding",
1090      *  And the router is not on the same subnet as the destination of the
1091      *          trace,
1092      *  then drop this packet.  The "#if 0"'d code saves it and returns
1093      *   it on timeout, but timeouts are too common (e.g. routers with
1094      *   limited unicast routing tables, etc).
1095      */
1096     if (len == 1 && r->tr_rproto == 0 && r->tr_rmtaddr == 0 &&
1097                                         r->tr_rflags == TR_NO_FWD) {
1098         u_int32 smask;
1099
1100         VAL_TO_MASK(smask, r->tr_smask);
1101         if ((r->tr_outaddr & smask) != (qdst & smask)) {
1102 #if 0
1103             /* XXX should do this silently? */
1104             fprintf(stderr, "mtrace: probably IOS-buggy packet from %s\n",
1105                 inet_fmt(((struct sockaddr_in *)addr)->sin_addr.s_addr, s1));
1106             /* Save the packet to return if a timeout occurs. */
1107             savbuf = (u_char *)malloc(buflen);
1108             if (savbuf != NULL) {
1109                 bcopy(buf, savbuf, buflen);
1110                 savbuflen = buflen;
1111                 savaddr = (struct sockaddr *)malloc(*addrlen);
1112                 if (savaddr != NULL) {
1113                     bcopy(addr, savaddr, *addrlen);
1114                     savaddrlen = *addrlen;
1115                     bcopy(ts, &savts, sizeof(savts));
1116                 } else {
1117                     free(savbuf);
1118                     savbuf = NULL;
1119                 }
1120             }
1121 #endif
1122             return 0;
1123         }
1124     }
1125     return buflen;
1126 }
1127
1128 int
1129 send_recv(u_int32 dst, int type, int code, int tries, struct resp_buf *save,
1130           callback_t callback)
1131 {
1132     fd_set  fds;
1133     struct timeval tq, tr, tv;
1134     struct ip *ip;
1135     struct igmp *igmp;
1136     struct tr_query *query, *rquery;
1137     struct tr_resp *r;
1138     struct sockaddr_in recvaddr;
1139     u_int32 local, group;
1140     int ipdatalen, iphdrlen, igmpdatalen;
1141     int datalen;
1142     int count, recvlen, socklen = sizeof(recvaddr);
1143     int len;
1144     int i;
1145
1146     if (type == IGMP_MTRACE) {
1147         group = qgrp;
1148         datalen = sizeof(struct tr_query);
1149     } else {
1150         group = htonl(0xff03);
1151         datalen = 0;
1152     }
1153     if (IN_MULTICAST(ntohl(dst))) local = lcl_addr;
1154     else local = INADDR_ANY;
1155
1156     /*
1157      * If the reply address was not explictly specified, start off
1158      * with the standard multicast reply address, or the unicast
1159      * address of this host if the unicast flag was specified.
1160      * Then, if there is no response after trying half the tries
1161      * with multicast, switch to the unicast address of this host
1162      * if the multicast flag was not specified.  If the TTL was
1163      * also not specified, set a multicast TTL and increase it
1164      * for every try.
1165      */
1166     query = (struct tr_query *)(send_buf + MIN_IP_HEADER_LEN + IGMP_MINLEN);
1167     query->tr_raddr = raddr ? raddr : unicast ? lcl_addr : resp_cast;
1168     TR_SETTTL(query->tr_rttlqid, rttl ? rttl :
1169       IN_MULTICAST(ntohl(query->tr_raddr)) ? get_ttl(save) : UNICAST_TTL);
1170     query->tr_src   = qsrc;
1171     query->tr_dst   = qdst;
1172
1173     for (i = tries ; i > 0; --i) {
1174         int oqid;
1175
1176         if (tries == nqueries && raddr == 0) {
1177             if (i == (nqueries >> 1)) {
1178                 if (multicast && unicast) {
1179                     query->tr_raddr = resp_cast;
1180                     if (!rttl)
1181                         TR_SETTTL(query->tr_rttlqid, get_ttl(save));
1182                 } else if (!multicast) {
1183                     query->tr_raddr = lcl_addr;
1184                     TR_SETTTL(query->tr_rttlqid, UNICAST_TTL);
1185                 }
1186             }
1187             if (i < tries && IN_MULTICAST(ntohl(query->tr_raddr)) &&
1188                                                                 rttl == 0) {
1189                 TR_SETTTL(query->tr_rttlqid,
1190                         TR_GETTTL(query->tr_rttlqid) + MULTICAST_TTL_INC);
1191                 if (TR_GETTTL(query->tr_rttlqid) > MULTICAST_TTL_MAX)
1192                   TR_SETTTL(query->tr_rttlqid, MULTICAST_TTL_MAX);
1193             }
1194         }
1195
1196         /*
1197          * Change the qid for each request sent to avoid being confused
1198          * by duplicate responses
1199          */
1200         oqid = TR_GETQID(query->tr_rttlqid);
1201         if (staticqid)
1202             TR_SETQID(query->tr_rttlqid, staticqid);
1203         else
1204 #ifdef SYSV    
1205             TR_SETQID(query->tr_rttlqid, ((u_int32)lrand48() >> 8));
1206 #else
1207             TR_SETQID(query->tr_rttlqid, ((u_int32)arc4random() >> 8));
1208 #endif
1209
1210         /*
1211          * Set timer to calculate delays, then send query
1212          */
1213         gettimeofday(&tq, 0);
1214         send_igmp(local, dst, type, code, group, datalen);
1215
1216         /*
1217          * Wait for response, discarding false alarms
1218          */
1219         while (TRUE) {
1220             if (igmp_socket >= FD_SETSIZE)
1221                     dolog(LOG_ERR, 0, "descriptor too big");
1222             FD_ZERO(&fds);
1223             FD_SET(igmp_socket, &fds);
1224             gettimeofday(&tv, 0);
1225             tv.tv_sec = tq.tv_sec + timeout - tv.tv_sec;
1226             tv.tv_usec = tq.tv_usec - tv.tv_usec;
1227             if (tv.tv_usec < 0) tv.tv_usec += 1000000L, --tv.tv_sec;
1228             if (tv.tv_sec < 0) tv.tv_sec = tv.tv_usec = 0;
1229
1230             count = select(igmp_socket + 1, &fds, NULL, NULL, &tv);
1231
1232             if (count < 0) {
1233                 if (errno != EINTR) warn("select");
1234                 continue;
1235             } else if (count == 0) {
1236                 /*
1237                  * Timed out.  Notify the callback.
1238                  */
1239                 if (!callback || (recvlen = (callback)(1, recv_buf, 0, NULL, 0, (struct sockaddr *)&recvaddr, &socklen, &tr)) == 0) {
1240                     printf("* ");
1241                     fflush(stdout);
1242                     break;
1243                 }
1244             } else {
1245                 /*
1246                  * Data is available on the socket, so read it.
1247                  */
1248                 gettimeofday(&tr, 0);
1249                 recvlen = recvfrom(igmp_socket, recv_buf, RECV_BUF_SIZE,
1250                                    0, (struct sockaddr *)&recvaddr, &socklen);
1251             }
1252
1253             if (recvlen <= 0) {
1254                 if (recvlen && errno != EINTR) warn("recvfrom");
1255                 continue;
1256             }
1257
1258             if (recvlen < sizeof(struct ip)) {
1259                 warnx("packet too short (%u bytes) for IP header", recvlen);
1260                 continue;
1261             }
1262             ip = (struct ip *) recv_buf;
1263             if (ip->ip_p == 0)  /* ignore cache creation requests */
1264                 continue;
1265
1266             iphdrlen = ip->ip_hl << 2;
1267 #ifdef RAW_INPUT_IS_RAW
1268             ipdatalen = ntohs(ip->ip_len);
1269 #else
1270             ipdatalen = ip->ip_len;
1271 #endif
1272             if (iphdrlen + ipdatalen != recvlen) {
1273                 warnx("packet shorter (%u bytes) than hdr+data len (%u+%u)",
1274                         recvlen, iphdrlen, ipdatalen);
1275                 continue;
1276             }
1277
1278             igmp = (struct igmp *) (recv_buf + iphdrlen);
1279             igmpdatalen = ipdatalen - IGMP_MINLEN;
1280             if (igmpdatalen < 0) {
1281                 warnx("IP data field too short (%u bytes) for IGMP from %s",
1282                         ipdatalen, inet_fmt(ip->ip_src.s_addr, s1));
1283                 continue;
1284             }
1285
1286             switch (igmp->igmp_type) {
1287
1288               case IGMP_DVMRP:
1289                 if (type != IGMP_DVMRP || code != DVMRP_ASK_NEIGHBORS2)
1290                         continue;
1291                 if (igmp->igmp_code != DVMRP_NEIGHBORS2) continue;
1292                 len = igmpdatalen;
1293                 /*
1294                  * Accept DVMRP_NEIGHBORS2 response if it comes from the
1295                  * address queried or if that address is one of the local
1296                  * addresses in the response.
1297                  */
1298                 if (ip->ip_src.s_addr != dst) {
1299                     u_int32 *p = (u_int32 *)(igmp + 1);
1300                     u_int32 *ep = p + (len >> 2);
1301                     while (p < ep) {
1302                         u_int32 laddr = *p++;
1303                         int n = ntohl(*p++) & 0xFF;
1304                         if (laddr == dst) {
1305                             ep = p + 1;         /* ensure p < ep after loop */
1306                             break;
1307                         }
1308                         p += n;
1309                     }
1310                     if (p >= ep) continue;
1311                 }
1312                 break;
1313
1314               case IGMP_MTRACE:     /* For backward compatibility with 3.3 */
1315               case IGMP_MTRACE_RESP:
1316                 if (type != IGMP_MTRACE) continue;
1317                 if (igmpdatalen <= QLEN) continue;
1318                 if ((igmpdatalen - QLEN)%RLEN) {
1319                     printf("packet with incomplete responses (%d bytes)\n",
1320                         igmpdatalen);
1321                     continue;
1322                 }
1323
1324                 /*
1325                  * Ignore responses that don't match query.
1326                  */
1327                 rquery = (struct tr_query *)(igmp + 1);
1328                 if (rquery->tr_src != qsrc || rquery->tr_dst != qdst)
1329                     continue;
1330                 if (TR_GETQID(rquery->tr_rttlqid) !=
1331                         TR_GETQID(query->tr_rttlqid)) {
1332                     if (verbose && TR_GETQID(rquery->tr_rttlqid) == oqid)
1333                         printf("[D]");
1334                     continue;
1335                 }
1336                 len = (igmpdatalen - QLEN)/RLEN;
1337                 r = (struct tr_resp *)(rquery+1) + len - 1;
1338
1339                 /*
1340                  * Ignore trace queries passing through this node when
1341                  * mtrace is run on an mrouter that is in the path
1342                  * (needed only because IGMP_MTRACE is accepted above
1343                  * for backward compatibility with multicast release 3.3).
1344                  */
1345                 if (igmp->igmp_type == IGMP_MTRACE) {
1346                     u_int32 smask;
1347
1348                     VAL_TO_MASK(smask, r->tr_smask);
1349                     if (len < code && (r->tr_inaddr & smask) != (qsrc & smask)
1350                         && r->tr_rmtaddr != 0 && !(r->tr_rflags & 0x80))
1351                       continue;
1352                 }
1353                 /*
1354                  * Some routers will return error messages without
1355                  * filling in their addresses.  We fill in the address
1356                  * for them.
1357                  */
1358                 if (r->tr_outaddr == 0)
1359                     r->tr_outaddr = recvaddr.sin_addr.s_addr;
1360
1361                 /*
1362                  * A match, we'll keep this one.
1363                  */
1364                 if (len > code) {
1365                     warnx("num hops received (%d) exceeds request (%d)",
1366                             len, code);
1367                 }
1368                 rquery->tr_raddr = query->tr_raddr;     /* Insure these are */
1369                 TR_SETTTL(rquery->tr_rttlqid, TR_GETTTL(query->tr_rttlqid));
1370                                                         /* as we sent them */
1371                 break;
1372
1373               default:
1374                 continue;
1375             }
1376
1377             /*
1378              * We're pretty sure we want to use this packet now,
1379              * but if the caller gave a callback function, it might
1380              * want to handle it instead.  Give the callback a chance,
1381              * unless the select timed out (in which case the only way
1382              * to get here is because the callback returned a packet).
1383              */
1384             if (callback && (count != 0) && ((callback)(0, recv_buf, recvlen, igmp, igmpdatalen, (struct sockaddr*)&recvaddr, &socklen, &tr)) == 0) {
1385                 /*
1386                  * The callback function didn't like this packet.
1387                  * Go try receiving another one.
1388                  */
1389                 continue;
1390             }
1391
1392             /*
1393              * Most of the sanity checking done at this point.
1394              * Return this packet we have been waiting for.
1395              */
1396             if (save) {
1397                 save->qtime = ((tq.tv_sec + JAN_1970) << 16) +
1398                               (tq.tv_usec << 10) / 15625;
1399                 save->rtime = ((tr.tv_sec + JAN_1970) << 16) +
1400                               (tr.tv_usec << 10) / 15625;
1401                 save->len = len;
1402                 bcopy((char *)igmp, (char *)&save->igmp, ipdatalen);
1403             }
1404             return (recvlen);
1405         }
1406     }
1407     return (0);
1408 }
1409
1410 /*
1411  * Most of this code is duplicated elsewhere.  I'm not sure if
1412  * the duplication is absolutely required or not.
1413  *
1414  * Ideally, this would keep track of ongoing statistics
1415  * collection and print out statistics.  (& keep track
1416  * of h-b-h traces and only print the longest)  For now,
1417  * it just snoops on what traces it can.
1418  */
1419 void
1420 passive_mode(void)
1421 {
1422     struct timeval tr;
1423     time_t tr_sec;
1424     struct ip *ip;
1425     struct igmp *igmp;
1426     struct tr_resp *r;
1427     struct sockaddr_in recvaddr;
1428     struct tm *now;
1429     char timebuf[32];
1430     int socklen;
1431     int ipdatalen, iphdrlen, igmpdatalen;
1432     int len, recvlen;
1433     int qid;
1434     u_int32 smask;
1435     struct mtrace *remembered = NULL, *m, *n, **nn;
1436     int pc = 0;
1437
1438     if (raddr) {
1439         if (IN_MULTICAST(ntohl(raddr))) k_join(raddr, lcl_addr);
1440     } else k_join(htonl(0xE0000120), lcl_addr);
1441
1442     while (1) {
1443         fflush(stdout);         /* make sure previous trace is flushed */
1444
1445         socklen = sizeof(recvaddr);
1446         recvlen = recvfrom(igmp_socket, recv_buf, RECV_BUF_SIZE,
1447                            0, (struct sockaddr *)&recvaddr, &socklen);
1448         gettimeofday(&tr,0);
1449
1450         if (recvlen <= 0) {
1451             if (recvlen && errno != EINTR) warn("recvfrom");
1452             continue;
1453         }
1454
1455         if (recvlen < sizeof(struct ip)) {
1456             warnx("packet too short (%u bytes) for IP header", recvlen);
1457             continue;
1458         }
1459         ip = (struct ip *) recv_buf;
1460         if (ip->ip_p == 0)      /* ignore cache creation requests */
1461             continue;
1462
1463         iphdrlen = ip->ip_hl << 2;
1464 #ifdef RAW_INPUT_IS_RAW
1465         ipdatalen = ntohs(ip->ip_len);
1466 #else
1467         ipdatalen = ip->ip_len;
1468 #endif
1469         if (iphdrlen + ipdatalen != recvlen) {
1470             warnx("packet shorter (%u bytes) than hdr+data len (%u+%u)",
1471                     recvlen, iphdrlen, ipdatalen);
1472             continue;
1473         }
1474
1475         igmp = (struct igmp *) (recv_buf + iphdrlen);
1476         igmpdatalen = ipdatalen - IGMP_MINLEN;
1477         if (igmpdatalen < 0) {
1478             warnx("IP data field too short (%u bytes) for IGMP from %s",
1479                     ipdatalen, inet_fmt(ip->ip_src.s_addr, s1));
1480             continue;
1481         }
1482
1483         switch (igmp->igmp_type) {
1484
1485           case IGMP_MTRACE:         /* For backward compatibility with 3.3 */
1486           case IGMP_MTRACE_RESP:
1487             if (igmpdatalen < QLEN) continue;
1488             if ((igmpdatalen - QLEN)%RLEN) {
1489                 printf("packet with incorrect datalen\n");
1490                 continue;
1491             }
1492
1493             len = (igmpdatalen - QLEN)/RLEN;
1494
1495             break;
1496
1497           default:
1498             continue;
1499         }
1500
1501         base.qtime = ((tr.tv_sec + JAN_1970) << 16) +
1502                       (tr.tv_usec << 10) / 15625;
1503         base.rtime = ((tr.tv_sec + JAN_1970) << 16) +
1504                       (tr.tv_usec << 10) / 15625;
1505         base.len = len;
1506         bcopy((char *)igmp, (char *)&base.igmp, ipdatalen);
1507         /*
1508          * If the user specified which traces to monitor,
1509          * only accept traces that correspond to the
1510          * request
1511          */
1512         if ((qsrc != 0 && qsrc != base.qhdr.tr_src) ||
1513             (qdst != 0 && qdst != base.qhdr.tr_dst) ||
1514             (qgrp != 0 && qgrp != igmp->igmp_group.s_addr))
1515             continue;
1516
1517         /* XXX This should be a hash table */
1518         /* XXX garbage-collection should be more efficient */
1519         for (nn = &remembered, n = *nn, m = NULL; n; n = *nn) {
1520             if ((n->base.qhdr.tr_src == base.qhdr.tr_src) &&
1521                 (n->base.qhdr.tr_dst == base.qhdr.tr_dst) &&
1522                 (n->base.igmp.igmp_group.s_addr == igmp->igmp_group.s_addr)) {
1523                 m = n;
1524                 m->last = tr;
1525             }
1526             if (tr.tv_sec - n->last.tv_sec > 500) { /* XXX don't hardcode */
1527                 *nn = n->next;
1528                 free(n);
1529             } else {
1530                 nn = &n->next;
1531             }
1532         }
1533
1534         tr_sec = tr.tv_sec;
1535         now = localtime(&tr_sec);
1536         strftime(timebuf, sizeof(timebuf) - 1, "%b %e %k:%M:%S", now);
1537         printf("Mtrace %s at %s",
1538                 len == 0 ? "query" :
1539                            igmp->igmp_type == IGMP_MTRACE_RESP ? "response" :
1540                                                                  "in transit",
1541                 timebuf);
1542         if (len == 0)
1543                 printf(" by %s", inet_fmt(recvaddr.sin_addr.s_addr, s1));
1544         if (!IN_MULTICAST(base.qhdr.tr_raddr))
1545                 printf(", resp to %s", (len == 0 && recvaddr.sin_addr.s_addr == base.qhdr.tr_raddr) ? "same" : inet_fmt(base.qhdr.tr_raddr, s1));
1546         else
1547                 printf(", respttl %d", TR_GETTTL(base.qhdr.tr_rttlqid));
1548         printf(", qid %06x\n", qid = TR_GETQID(base.qhdr.tr_rttlqid));
1549         printf("packet from %s to %s\n",
1550                 inet_fmt(ip->ip_src.s_addr, s1),
1551                 inet_fmt(ip->ip_dst.s_addr, s2));
1552
1553         printf("from %s to %s via group %s (mxhop=%d)\n",
1554                 inet_fmt(base.qhdr.tr_dst, s1), inet_fmt(base.qhdr.tr_src, s2),
1555                 inet_fmt(igmp->igmp_group.s_addr, s3), igmp->igmp_code);
1556         if (len == 0) {
1557             printf("\n");
1558             continue;
1559         }
1560         r = base.resps + base.len - 1;
1561         /*
1562          * Some routers will return error messages without
1563          * filling in their addresses.  We fill in the address
1564          * for them.
1565          */
1566         if (r->tr_outaddr == 0)
1567             r->tr_outaddr = recvaddr.sin_addr.s_addr;
1568
1569         /*
1570          * If there was a previous trace, it see if this is a
1571          * statistics candidate.
1572          */
1573         if (m && base.len == m->base.len &&
1574                 !(pc = path_changed(&m->base, &base))) {
1575             /*
1576              * Some mtrace responders send multiple copies of the same
1577              * reply.  Skip this packet if it's got the same query-id
1578              * as the last one.
1579              */
1580             if (m->lastqid == qid) {
1581                 printf("Skipping duplicate reply\n");
1582                 continue;
1583             }
1584
1585             m->lastqid = qid;
1586
1587             ++m->nresp;
1588
1589             bcopy(&base, m->new, sizeof(base));
1590
1591             printf("Results after %d seconds:\n\n",
1592                    (int)((m->new->qtime - m->base.qtime) >> 16));
1593             fixup_stats(&m->base, m->prev, m->new, m->bugs);
1594             print_stats(&m->base, m->prev, m->new, m->bugs, m->names);
1595             m->prev = m->new;
1596             m->new = &m->incr[(m->nresp & 1)];
1597
1598             continue;
1599         }
1600
1601         if (m == NULL) {
1602             m = (struct mtrace *)malloc(sizeof(struct mtrace));
1603             if (m == NULL) {
1604                 fprintf(stderr, "Out of memory!\n");
1605                 continue;
1606             }
1607             bzero(m, sizeof(struct mtrace));
1608             m->next = remembered;
1609             remembered = m;
1610             bcopy(&tr, &m->last, sizeof(tr));
1611         }
1612
1613         /* Either it's a hop-by-hop in progress, or the path changed. */
1614         if (pc) {
1615             printf("[Path Changed...]\n");
1616             bzero(m->bugs, sizeof(m->bugs));
1617         }
1618         bcopy(&base, &m->base, sizeof(base));
1619         m->prev = &m->base;
1620         m->new = &m->incr[0];
1621         m->nresp = 0;
1622
1623         printf("  0  ");
1624         print_host(base.qhdr.tr_dst);
1625         printf("\n");
1626         print_trace(1, &base, m->names);
1627         VAL_TO_MASK(smask, r->tr_smask);
1628         if ((r->tr_inaddr & smask) == (base.qhdr.tr_src & smask)) {
1629             printf("%3d  ", -(base.len+1));
1630             print_host(base.qhdr.tr_src);
1631             printf("\n");
1632         } else if (r->tr_rmtaddr != 0) {
1633             printf("%3d  ", -(base.len+1));
1634             print_host(r->tr_rmtaddr);
1635             printf(" %s\n", r->tr_rflags == TR_OLD_ROUTER ?
1636                                    "doesn't support mtrace"
1637                                  : "is the next hop");
1638         }
1639         printf("\n");
1640     }
1641 }
1642
1643 char *
1644 print_host(u_int32 addr)
1645 {
1646     return print_host2(addr, 0);
1647 }
1648
1649 /*
1650  * On some routers, one interface has a name and the other doesn't.
1651  * We always print the address of the outgoing interface, but can
1652  * sometimes get the name from the incoming interface.  This might be
1653  * confusing but should be slightly more helpful than just a "?".
1654  */
1655 char *
1656 print_host2(u_int32 addr1, u_int32 addr2)
1657 {
1658     char *name;
1659
1660     if (numeric) {
1661         printf("%s", inet_fmt(addr1, s1));
1662         return ("");
1663     }
1664     name = inet_name(addr1);
1665     if (*name == '?' && *(name + 1) == '\0' && addr2 != 0)
1666         name = inet_name(addr2);
1667     printf("%s (%s)", name, inet_fmt(addr1, s1));
1668     return (name);
1669 }
1670
1671 /*
1672  * Print responses as received (reverse path from dst to src)
1673  */
1674 void
1675 print_trace(int idx, struct resp_buf *buf, char **names)
1676 {
1677     struct tr_resp *r;
1678     char *name;
1679     int i;
1680     int hop;
1681     char *ms;
1682
1683     i = abs(idx);
1684     r = buf->resps + i - 1;
1685
1686     for (; i <= buf->len; ++i, ++r) {
1687         if (idx > 0) printf("%3d  ", -i);
1688         name = print_host2(r->tr_outaddr, r->tr_inaddr);
1689         if (r->tr_rflags != TR_NO_RTE)
1690             printf("  %s  thresh^ %d", proto_type(r->tr_rproto), r->tr_fttl);
1691         if (verbose) {
1692             hop = t_diff(ntohl(r->tr_qarr), buf->qtime);
1693             ms = scale(&hop);
1694             printf("  %d%s", hop, ms);
1695         }
1696         printf("  %s", flag_type(r->tr_rflags));
1697         if (i > 1 && r->tr_outaddr != (r-1)->tr_rmtaddr) {
1698             printf(" !RPF!");
1699             print_host((r-1)->tr_rmtaddr);
1700         }
1701         if (r->tr_rflags != TR_NO_RTE) {
1702             if (r->tr_smask <= 1)    /* MASK_TO_VAL() returns 1 for default */
1703                 printf(" [default]");
1704             else if (verbose) {
1705                 u_int32 smask;
1706
1707                 VAL_TO_MASK(smask, r->tr_smask);
1708                 printf(" [%s]", inet_fmts(buf->qhdr.tr_src & smask,
1709                                                         smask, s1));
1710             }
1711         }
1712         printf("\n");
1713         if (names[i-1])
1714             free(names[i-1]);
1715         names[i-1]=malloc(strlen(name) + 1);
1716         strcpy(names[i-1], name);
1717     }
1718 }
1719
1720 /*
1721  * See what kind of router is the next hop
1722  */
1723 int
1724 what_kind(struct resp_buf *buf, char *why)
1725 {
1726     u_int32 smask;
1727     int retval;
1728     int hops = buf->len;
1729     struct tr_resp *r = buf->resps + hops - 1;
1730     u_int32 next = r->tr_rmtaddr;
1731
1732     retval = send_recv(next, IGMP_DVMRP, DVMRP_ASK_NEIGHBORS2, 1, &incr[0], NULL);
1733     print_host(next);
1734     if (retval) {
1735         u_int32 version = ntohl(incr[0].igmp.igmp_group.s_addr);
1736         u_int32 *p = (u_int32 *)incr[0].ndata;
1737         u_int32 *ep = p + (incr[0].len >> 2);
1738         char *type = "version ";
1739
1740         retval = 0;
1741         switch (version & 0xFF) {
1742           case 1:
1743             type = "proteon/mrouted ";
1744             retval = 1;
1745             break;
1746
1747           case 10:
1748           case 11:
1749             type = "cisco ";
1750         }
1751         printf(" [%s%d.%d] %s\n",
1752                type, version & 0xFF, (version >> 8) & 0xFF,
1753                why);
1754         VAL_TO_MASK(smask, r->tr_smask);
1755         while (p < ep) {
1756             u_int32 laddr = *p++;
1757             int flags = (ntohl(*p) & 0xFF00) >> 8;
1758             int n = ntohl(*p++) & 0xFF;
1759             if (!(flags & (DVMRP_NF_DOWN | DVMRP_NF_DISABLED)) &&
1760                  (laddr & smask) == (qsrc & smask)) {
1761                 printf("%3d  ", -(hops+2));
1762                 print_host(qsrc);
1763                 printf("\n");
1764                 return 1;
1765             }
1766             p += n;
1767         }
1768         return retval;
1769     }
1770     printf(" %s\n", why);
1771     return 0;
1772 }
1773
1774
1775 char *
1776 scale(int *hop)
1777 {
1778     if (*hop > -1000 && *hop < 10000) 
1779             return (" ms");
1780     *hop /= 1000;
1781     if (*hop > -1000 && *hop < 10000) 
1782             return (" s ");
1783     return ("s ");
1784 }
1785
1786 /*
1787  * Calculate and print one line of packet loss and packet rate statistics.
1788  * Checks for count of all ones from mrouted 2.3 that doesn't have counters.
1789  */
1790 #define NEITHER 0
1791 #define INS     1
1792 #define OUTS    2
1793 #define BOTH    3
1794 void
1795 stat_line(struct tr_resp *r, struct tr_resp *s, int have_next, int *rst)
1796 {
1797     int timediff = (ntohl(s->tr_qarr) - ntohl(r->tr_qarr)) >> 16;
1798     int v_lost, v_pct;
1799     int g_lost, g_pct;
1800     int v_out = ntohl(s->tr_vifout) - ntohl(r->tr_vifout);
1801     int g_out = ntohl(s->tr_pktcnt) - ntohl(r->tr_pktcnt);
1802     int v_pps, g_pps;
1803     char v_str[8], g_str[8];
1804     int vhave = NEITHER;
1805     int ghave = NEITHER;
1806     int gmissing = NEITHER;
1807     char whochar;
1808     int badtime = 0;
1809
1810     if (timediff == 0) {
1811         badtime = 1;
1812         /* Might be 32 bits of int seconds instead of 16int+16frac */
1813         timediff = ntohl(s->tr_qarr) - ntohl(r->tr_qarr);
1814         if (timediff == 0 || abs(timediff - statint) > statint)
1815             timediff = 1;
1816     }
1817     v_pps = v_out / timediff;
1818     g_pps = g_out / timediff;
1819
1820 #define STATS_MISSING(x)        ((x) == 0xFFFFFFFF)
1821
1822     if (!STATS_MISSING(s->tr_vifout) && !STATS_MISSING(r->tr_vifout))
1823             vhave |= OUTS;
1824     if (STATS_MISSING(s->tr_pktcnt) || STATS_MISSING(r->tr_pktcnt))
1825             gmissing |= OUTS;
1826     if (!(*rst & BUG_NOPRINT))
1827             ghave |= OUTS;
1828
1829     if (have_next) {
1830         --r,  --s,  --rst;
1831         if (!STATS_MISSING(s->tr_vifin) && !STATS_MISSING(r->tr_vifin))
1832             vhave |= INS;
1833         if (STATS_MISSING(s->tr_pktcnt) || STATS_MISSING(r->tr_pktcnt))
1834             gmissing |= INS;
1835         if (!(*rst & BUG_NOPRINT))
1836             ghave |= INS;
1837     }
1838
1839     /*
1840      * Stats can be missing for any number of reasons:
1841      * - The hop may not be capable of collecting stats
1842      * - Traffic may be getting dropped at the previous hop
1843      *   and so this hop may not have any state
1844      *
1845      * We need a stronger heuristic to tell between these
1846      * two cases; in case 1 we don't want to print the stats
1847      * and in case 2 we want to print 100% loss.  We used to
1848      * err on the side of not printing, which is less useful
1849      * than printing 100% loss and dealing with it.
1850      */
1851 #if 0
1852     /*
1853      * If both hops report as missing, then it's likely that there's just
1854      * no traffic flowing.
1855      *
1856      * If just one hop is missing, then we really don't have it.
1857      */
1858     if (gmissing != BOTH)
1859         ghave &= ~gmissing;
1860 #endif
1861
1862     whochar = have_next ? '^' : ' ';
1863     switch (vhave) {
1864       case BOTH:
1865         v_lost = v_out - (ntohl(s->tr_vifin) - ntohl(r->tr_vifin));
1866         if (v_out) v_pct = v_lost * 100 / v_out;
1867         else v_pct = 0;
1868         if (-20 < v_pct && v_pct < 101 && v_out > 10)
1869           sprintf(v_str, "%3d%%", v_pct);
1870         else if (v_pct < -900 && v_out > 10)
1871           sprintf(v_str, "%3dx", (int)(-v_pct / 100. + 1.));
1872         else if (v_pct <= -20 && v_out > 10)
1873           sprintf(v_str, "%1.1fx", -v_pct / 100. + 1.);
1874         else
1875           memcpy(v_str, " -- ", 5);
1876
1877         if (tunstats)
1878             printf("%6d/%-5d=%s", v_lost, v_out, v_str);
1879         else
1880             printf("   ");
1881         printf("%4d pps", v_pps);
1882         if (v_pps && badtime)
1883             printf("?");
1884
1885         break;
1886
1887       case INS:
1888         v_out = ntohl(s->tr_vifin) - ntohl(r->tr_vifin);
1889         v_pps = v_out / timediff;
1890         whochar = 'v';
1891         /* FALLTHROUGH */
1892
1893       case OUTS:
1894         if (tunstats)
1895             printf("      %c%-5d     ", whochar, v_out);
1896         else
1897             printf("  %c", whochar);
1898         printf("%4d pps", v_pps);
1899         if (v_pps && badtime)
1900             printf("?");
1901
1902         break;
1903
1904       case NEITHER:
1905         if (ghave != NEITHER) {
1906             if (tunstats)
1907                 printf("                         ");
1908             else
1909                 printf("           ");
1910         }
1911
1912         break;
1913     }
1914
1915     whochar = have_next ? '^' : ' ';
1916     switch (ghave) {
1917       case BOTH:
1918         g_lost = g_out - (ntohl(s->tr_pktcnt) - ntohl(r->tr_pktcnt));
1919         if (g_out) g_pct = g_lost * 100 / g_out;
1920         else g_pct = 0;
1921         if (-20 < g_pct && g_pct < 101 && g_out > 10)
1922           sprintf(g_str, "%3d%%", g_pct);
1923         else if (g_pct < -900 && g_out > 10)
1924           sprintf(g_str, "%3dx", (int)(-g_pct / 100. + 1.));
1925         else if (g_pct <= -20 && g_out > 10)
1926           sprintf(g_str, "%1.1fx", -g_pct / 100. + 1.);
1927         else
1928           memcpy(g_str, " -- ", 5);
1929
1930         printf("%s%6d/%-5d=%s%4d pps",
1931                tunstats ? "" : "   ", g_lost, g_out, g_str, g_pps);
1932         if (g_pps && badtime)
1933             printf("?");
1934         printf("\n");
1935         break;
1936
1937 #if 0
1938       case INS:
1939         g_out = ntohl(s->tr_pktcnt) - ntohl(r->tr_pktcnt);
1940         g_pps = g_out / timediff;
1941         whochar = 'v';
1942         /* FALLTHROUGH */
1943 #endif
1944
1945       case OUTS:
1946         printf("%s     ?/%-5d     %4d pps",
1947                tunstats ? "" : "   ", g_out, g_pps);
1948         if (badtime)
1949             printf("?");
1950         printf("\n");
1951         break;
1952
1953       case INS:
1954       case NEITHER:
1955         printf("\n");
1956         break;
1957     }
1958
1959
1960     if (debug > 2) {
1961         printf("\t\t\t\tv_in: %ld ", (long)ntohl(s->tr_vifin));
1962         printf("v_out: %ld ", (long)ntohl(s->tr_vifout));
1963         printf("pkts: %ld\n", (long)ntohl(s->tr_pktcnt));
1964         printf("\t\t\t\tv_in: %ld ", (long)ntohl(r->tr_vifin));
1965         printf("v_out: %ld ", (long)ntohl(r->tr_vifout));
1966         printf("pkts: %ld\n", (long)ntohl(r->tr_pktcnt));
1967         printf("\t\t\t\tv_in: %ld ",
1968             (long)(ntohl(s->tr_vifin) - ntohl(r->tr_vifin)));
1969         printf("v_out: %ld ",
1970             (long)(ntohl(s->tr_vifout) - ntohl(r->tr_vifout)));
1971         printf("pkts: %ld ", (long)(ntohl(s->tr_pktcnt) - ntohl(r->tr_pktcnt)));
1972         printf("time: %d\n", timediff);
1973         printf("\t\t\t\treset: %x hoptime: %x\n", *rst, ntohl(s->tr_qarr));
1974     }
1975 }
1976
1977 /*
1978  * A fixup to check if any pktcnt has been reset, and to fix the
1979  * byteorder bugs in mrouted 3.6 on little-endian machines.
1980  *
1981  * XXX Since periodic traffic sources are likely to have their
1982  *     pktcnt periodically reset, should we save old values when
1983  *     the reset occurs to keep slightly better statistics over
1984  *     the long term?  (e.g. SAP)
1985  */
1986 void
1987 fixup_stats(struct resp_buf *base, struct resp_buf *prev, struct resp_buf *new,
1988             int *bugs)
1989 {
1990     int rno = base->len;
1991     struct tr_resp *b = base->resps + rno;
1992     struct tr_resp *p = prev->resps + rno;
1993     struct tr_resp *n = new->resps + rno;
1994     int *r = bugs + rno;
1995     int res;
1996     int cleanup = 0;
1997
1998     /* Check for byte-swappers.  Only check on the first trace,
1999      * since long-running traces can wrap around and falsely trigger. */
2000     while (--rno >= 0) {
2001 #ifdef TEST_ONLY
2002         u_int32 nvifout = ntohl(n->tr_vifout);
2003         u_int32 pvifout = ntohl(p->tr_vifout);
2004 #endif
2005         --n; --p; --b;
2006 #ifdef TEST_ONLY        /*XXX this is still buggy, so disable it for release */
2007         if ((*r & BUG_SWAP) ||
2008             ((base == prev) &&
2009              (nvifout - pvifout) > (byteswap(nvifout) - byteswap(pvifout)))) {
2010             if (1 || debug > 2) {
2011                 printf("ip %s swaps; b %08x p %08x n %08x\n",
2012                         inet_fmt(n->tr_inaddr, s1),
2013                         ntohl(b->tr_vifout), pvifout, nvifout);
2014             }
2015             /* This host sends byteswapped reports; swap 'em */
2016             if (!(*r & BUG_SWAP)) {
2017                 *r |= BUG_SWAP;
2018                 b->tr_qarr = byteswap(b->tr_qarr);
2019                 b->tr_vifin = byteswap(b->tr_vifin);
2020                 b->tr_vifout = byteswap(b->tr_vifout);
2021                 b->tr_pktcnt = byteswap(b->tr_pktcnt);
2022             }
2023
2024             n->tr_qarr = byteswap(n->tr_qarr);
2025             n->tr_vifin = byteswap(n->tr_vifin);
2026             n->tr_vifout = byteswap(n->tr_vifout);
2027             n->tr_pktcnt = byteswap(n->tr_pktcnt);
2028         }
2029 #endif
2030         /*
2031          * A missing parenthesis in mrouted 3.5-3.8's prune.c
2032          * causes extremely bogus time diff's.
2033          * One half of the time calculation was
2034          * inside an htonl() and one half wasn't.  Therefore, on
2035          * a little-endian machine, both halves of the calculation
2036          * would get added together in the little end.  Thus, the
2037          * low-order 2 bytes are either 0000 (no overflow) or
2038          * 0100 (overflow from the addition).
2039          *
2040          * Odds are against these particular bit patterns
2041          * happening in both prev and new for actual time values.
2042          */
2043         if ((*r & BUG_BOGUSTIME) || (((ntohl(n->tr_qarr) & 0xfeff) == 0x0000) &&
2044             ((ntohl(p->tr_qarr) & 0xfeff) == 0x0000))) {
2045             *r |= BUG_BOGUSTIME;
2046             n->tr_qarr = new->rtime;
2047             p->tr_qarr = prev->rtime;
2048             b->tr_qarr = base->rtime;
2049         }
2050     }
2051
2052     rno = base->len;
2053     b = base->resps + rno;
2054     p = prev->resps + rno;
2055     n = new->resps + rno;
2056     r = bugs + rno;
2057
2058     while (--rno >= 0) {
2059         --n; --p; --b; --r;
2060         /*
2061          * This hop has reset if:
2062          * - There were statistics in the base AND previous pass, AND
2063          *   - There are less packets this time than the first time and
2064          *     we didn't reset last time, OR
2065          *   - There are less packets this time than last time, OR
2066          *   - There are no statistics on this pass.
2067          *
2068          * The "and we didn't reset last time" is necessary in the
2069          * first branch of the OR because if the base is large and
2070          * we reset last time but the constant-resetter-avoidance
2071          * code kicked in so we delayed the copy of prev to base,
2072          * new could still be below base so we trigger the
2073          * constant-resetter code even though it was really only
2074          * a single reset.
2075          */
2076         res = ((b->tr_pktcnt != 0xFFFFFFFF) && (p->tr_pktcnt != 0xFFFFFFFF) &&
2077                ((!(*r & BUG_RESET) && ntohl(n->tr_pktcnt) < ntohl(b->tr_pktcnt)) ||
2078                 (ntohl(n->tr_pktcnt) < ntohl(p->tr_pktcnt)) ||
2079                 (n->tr_pktcnt == 0xFFFFFFFF)));
2080         if (debug > 2) {
2081             printf("\t\tip=%s, r=%d, res=%d\n", inet_fmt(b->tr_inaddr, s1), *r, res);
2082             if (res)
2083                 printf("\t\tbase=%u, prev=%u, new=%u\n", ntohl(b->tr_pktcnt),
2084                             ntohl(p->tr_pktcnt), ntohl(n->tr_pktcnt));
2085         }
2086         if (*r & BUG_RESET) {
2087             if (res || (*r & BUG_RESET2X)) {
2088                 /*
2089                  * This router appears to be a 3.4 with that nasty ol'
2090                  * neighbor version bug, which causes it to constantly
2091                  * reset.  Just nuke the statistics for this node, and
2092                  * don't even bother giving it the benefit of the
2093                  * doubt from now on.
2094                  */
2095                 p->tr_pktcnt = b->tr_pktcnt = n->tr_pktcnt;
2096                 *r |= BUG_RESET2X;
2097             } else {
2098                 /*
2099                  * This is simply the situation that the original
2100                  * fixup_stats was meant to deal with -- that a
2101                  * 3.3 or 3.4 router deleted a cache entry while
2102                  * traffic was still active.
2103                  */
2104                 *r &= ~BUG_RESET;
2105                 cleanup = 1;
2106             }
2107         } else
2108             if (res)
2109                 *r |= BUG_RESET;
2110     }
2111
2112     if (cleanup == 0) return;
2113
2114     /*
2115      * If some hop reset its counters and didn't continue to
2116      * reset, then we pretend that the previous
2117      * trace was the first one.
2118      */
2119     rno = base->len;
2120     b = base->resps + rno;
2121     p = prev->resps + rno;
2122
2123     while (--rno >= 0) (--b)->tr_pktcnt = (--p)->tr_pktcnt;
2124     base->qtime = prev->qtime;
2125     base->rtime = prev->rtime;
2126 }
2127
2128 /*
2129  * Check per-source losses along path and compare with threshold.
2130  */
2131 int
2132 check_thresh(int thresh, struct resp_buf *base, struct resp_buf *prev,
2133              struct resp_buf *new)
2134 {
2135     int rno = base->len - 1;
2136     struct tr_resp *b = base->resps + rno;
2137     struct tr_resp *p = prev->resps + rno;
2138     struct tr_resp *n = new->resps + rno;
2139     int g_out, g_lost;
2140
2141     while (TRUE) {
2142         if ((n->tr_inaddr != b->tr_inaddr) ||
2143             (n->tr_outaddr != b->tr_outaddr) ||
2144             (n->tr_rmtaddr != b->tr_rmtaddr))
2145           return 1;             /* Route changed */
2146
2147         if (rno-- < 1) break;
2148         g_out = ntohl(n->tr_pktcnt) - ntohl(p->tr_pktcnt);
2149         b--; n--; p--;
2150         g_lost = g_out - (ntohl(n->tr_pktcnt) - ntohl(p->tr_pktcnt));
2151         if (g_out && ((g_lost * 100 + (g_out >> 1))/ g_out) > thresh) {
2152             return TRUE;
2153         }
2154     }
2155     return FALSE;
2156 }
2157
2158 /*
2159  * Print responses with statistics for forward path (from src to dst)
2160  */
2161 int
2162 print_stats(struct resp_buf *base, struct resp_buf *prev, struct resp_buf *new,
2163             int *bugs, char **names)
2164 {
2165     int rtt, hop;
2166     char *ms;
2167     u_int32 smask;
2168     int rno = base->len - 1;
2169     struct tr_resp *b = base->resps + rno;
2170     struct tr_resp *p = prev->resps + rno;
2171     struct tr_resp *n = new->resps + rno;
2172     int *r = bugs + rno;
2173     u_long resptime = new->rtime;
2174     u_long qarrtime = ntohl(n->tr_qarr);
2175     u_int ttl = MaX(1, n->tr_fttl) + 1;
2176     int first = (base == prev);
2177
2178     VAL_TO_MASK(smask, b->tr_smask);
2179     printf("  Source        Response Dest    ");
2180     if (tunstats)
2181         printf("Packet Statistics For     Only For Traffic\n");
2182     else
2183         printf("Overall     Packet Statistics For Traffic From\n");
2184     inet_fmt(base->qhdr.tr_src, s1);
2185     printf("%-15s %-15s  ",
2186            ((b->tr_inaddr & smask) == (base->qhdr.tr_src & smask)) ?
2187                 s1 : "   * * *       ",
2188            inet_fmt(base->qhdr.tr_raddr, s2));
2189     inet_fmt(base->igmp.igmp_group.s_addr, s2);
2190     if (tunstats)
2191         printf("All Multicast Traffic     From %s\n", s1);
2192     else
2193         printf("Packet      %s To %s\n", s1, s2);
2194     rtt = t_diff(resptime, new->qtime);
2195     ms = scale(&rtt);
2196     printf("     %c       __/  rtt%5d%s    ",
2197            (first && !verbose) ? 'v' : '|', rtt, ms);
2198     if (tunstats)
2199         printf("Lost/Sent = Pct  Rate       To %s\n", s2);
2200     else
2201         printf(" Rate       Lost/Sent = Pct  Rate\n");
2202     if (!first || verbose) {
2203         hop = t_diff(resptime, qarrtime);
2204         ms = scale(&hop);
2205         printf("     v      /     hop%5d%s    ", hop, ms);
2206         if (tunstats)
2207             printf("---------------------     --------------------\n");
2208         else
2209             printf("-------     ---------------------\n");
2210     }
2211     if ((b->tr_inaddr & smask) != (base->qhdr.tr_src & smask) &&
2212             b->tr_rmtaddr != 0) {
2213         printf("%-15s %-14s is the previous hop\n", inet_fmt(b->tr_rmtaddr, s1),
2214                 inet_name(b->tr_rmtaddr));
2215         printf("     v     ^\n");
2216     }
2217     if (debug > 2) {
2218         printf("\t\t\t\tv_in: %ld ", (long)ntohl(n->tr_vifin));
2219         printf("v_out: %ld ", (long)ntohl(n->tr_vifout));
2220         printf("pkts: %ld\n", (long)ntohl(n->tr_pktcnt));
2221         printf("\t\t\t\tv_in: %ld ", (long)ntohl(b->tr_vifin));
2222         printf("v_out: %ld ", (long)ntohl(b->tr_vifout));
2223         printf("pkts: %ld\n", (long)ntohl(b->tr_pktcnt));
2224         printf("\t\t\t\tv_in: %ld ",
2225             (long)(ntohl(n->tr_vifin) - ntohl(b->tr_vifin)));
2226         printf("v_out: %ld ",
2227             (long)(ntohl(n->tr_vifout) - ntohl(b->tr_vifout)));
2228         printf("pkts: %ld\n",
2229             (long)(ntohl(n->tr_pktcnt) - ntohl(b->tr_pktcnt)));
2230         printf("\t\t\t\treset: %x hoptime: %lx\n", *r, (long)ntohl(n->tr_qarr));
2231     }
2232
2233     while (TRUE) {
2234         if ((n->tr_inaddr != b->tr_inaddr) ||
2235             (n->tr_outaddr != b->tr_outaddr) ||
2236             (n->tr_rmtaddr != b->tr_rmtaddr))
2237           return 1;             /* Route changed */
2238
2239         if ((n->tr_inaddr != n->tr_outaddr) && n->tr_inaddr)
2240           printf("%-15s\n", inet_fmt(n->tr_inaddr, s1));
2241         printf("%-15s %-14s %s%s\n", inet_fmt(n->tr_outaddr, s1), names[rno],
2242                  flag_type(n->tr_rflags),
2243                  (*r & BUG_NOPRINT) ? " [reset counters]" : "");
2244
2245         if (rno-- < 1) break;
2246
2247         printf("     %c     ^      ttl%5d   ", (first && !verbose) ? 'v' : '|',
2248                                                                 ttl);
2249         stat_line(p, n, TRUE, r);
2250         if (!first || verbose) {
2251             resptime = qarrtime;
2252             qarrtime = ntohl((n-1)->tr_qarr);
2253             hop = t_diff(resptime, qarrtime);
2254             ms = scale(&hop);
2255             printf("     v     |      hop%5d%s", hop, ms);
2256             if (first)
2257                 printf("\n");
2258             else
2259                 stat_line(b, n, TRUE, r);
2260         }
2261
2262         --b, --p, --n, --r;
2263         ttl = MaX(ttl, MaX(1, n->tr_fttl) + base->len - rno);
2264     }
2265            
2266     printf("     %c      \\__   ttl%5d   ", (first && !verbose) ? 'v' : '|',
2267                                                         ttl);
2268     stat_line(p, n, FALSE, r);
2269     if (!first || verbose) {
2270         hop = t_diff(qarrtime, new->qtime);
2271         ms = scale(&hop);
2272         printf("     v         \\  hop%5d%s", hop, ms);
2273         if (first)
2274             printf("\n");
2275         else
2276             stat_line(b, n, FALSE, r);
2277     }
2278     printf("%-15s %s\n", inet_fmt(base->qhdr.tr_dst, s1),
2279                         !passive ? inet_fmt(lcl_addr, s2) : "   * * *       ");
2280     printf("  Receiver      Query Source\n\n");
2281     return 0;
2282 }
2283
2284 /*
2285  * Determine whether or not the path has changed.
2286  */
2287 int
2288 path_changed(struct resp_buf *base, struct resp_buf *new)
2289 {
2290     int rno = base->len - 1;
2291     struct tr_resp *b = base->resps + rno;
2292     struct tr_resp *n = new->resps + rno;
2293
2294     while (rno-- >= 0) {
2295         if ((n->tr_inaddr != b->tr_inaddr) ||
2296             (n->tr_outaddr != b->tr_outaddr) ||
2297             (n->tr_rmtaddr != b->tr_rmtaddr))
2298           return 1;             /* Route changed */
2299         if ((b->tr_rflags == TR_NO_RTE) &&
2300             (n->tr_rflags != TR_NO_RTE))
2301           return 1;             /* Route got longer? */
2302         --n;
2303         --b;
2304     }
2305     return 0;
2306 }
2307
2308
2309 /***************************************************************************
2310  *      main
2311  ***************************************************************************/
2312
2313 int
2314 main(int argc, char **argv)
2315 {
2316     int udp;
2317     struct sockaddr_in addr;
2318     int addrlen = sizeof(addr);
2319     int recvlen;
2320     struct timeval tv;
2321     struct resp_buf *prev, *new;
2322     struct tr_resp *r;
2323     u_int32 smask;
2324     int rno;
2325     int hops, nexthop, tries;
2326     u_int32 lastout = 0;
2327     int numstats = 1;
2328     int waittime;
2329     int seed;
2330     int hopbyhop;
2331     int i;
2332     int printed = 1;
2333
2334     if (geteuid() != 0)
2335         errx(1, "must be root");
2336
2337     /*
2338      * We might get spawned by vat with the audio device open.
2339      * Close everything but stdin, stdout, stderr.
2340      */
2341     for (i = 3; i < 255; i++)
2342         close(i);
2343
2344     init_igmp();
2345     setuid(getuid());
2346
2347     argv++, argc--;
2348     if (argc == 0) usage();
2349
2350     while (argc > 0 && *argv[0] == '-') {
2351         char *p = *argv++;  argc--;
2352         p++;
2353         do {
2354             char c = *p++;
2355             char *arg = NULL;
2356             if (isdigit(*p)) {
2357                 arg = p;
2358                 p = "";
2359             } else if (argc > 0) arg = argv[0];
2360             switch (c) {
2361               case 'd':                 /* Unlisted debug print option */
2362                 if (arg && isdigit(*arg)) {
2363                     debug = atoi(arg);
2364                     if (debug < 0) debug = 0;
2365                     if (debug > 3) debug = 3;
2366                     if (arg == argv[0]) argv++, argc--;
2367                     break;
2368                 } else
2369                     usage();
2370               case 'M':                 /* Use multicast for reponse */
2371                 multicast = TRUE;
2372                 break;
2373               case 'U':                 /* Use unicast for response */
2374                 unicast = TRUE;
2375                 break;
2376               case 'L':                 /* Trace w/ loss threshold */
2377                 if (arg && isdigit(*arg)) {
2378                     lossthresh = atoi(arg);
2379                     if (lossthresh < 0)
2380                         lossthresh = 0;
2381                     numstats = 3153600;
2382                     if (arg == argv[0]) argv++, argc--;
2383                     break;
2384                 } else
2385                     usage();
2386                 break;
2387               case 'O':                 /* Don't use IP options */
2388                 sendopts = FALSE;
2389                 break;
2390               case 'P':                 /* Just watch the path */
2391                 printstats = FALSE;
2392                 numstats = 3153600;
2393                 break;
2394               case 'Q':                 /* (undoc.) always use this QID */
2395                 if (arg && isdigit(*arg)) {
2396                     staticqid = atoi(arg);
2397                     if (staticqid < 0)
2398                         staticqid = 0;
2399                     if (arg == argv[0]) argv++, argc--;
2400                     break;
2401                 } else
2402                     usage();
2403                 break;
2404               case 'T':                 /* Print confusing tunnel stats */
2405                 tunstats = TRUE;
2406                 break;
2407               case 'W':                 /* Cisco's "weak" mtrace */
2408                 weak = TRUE;
2409                 break;
2410               case 'V':                 /* Print version and exit */
2411                 fprintf(stderr, "mtrace version 5.2\n");
2412                 exit(1);
2413                 break;
2414               case 'l':                 /* Loop updating stats indefinitely */
2415                 numstats = 3153600;
2416                 break;
2417               case 'n':                 /* Don't reverse map host addresses */
2418                 numeric = TRUE;
2419                 break;
2420               case 'p':                 /* Passive listen for traces */
2421                 passive = TRUE;
2422                 break;
2423               case 'v':                 /* Verbosity */
2424                 verbose = TRUE;
2425                 break;
2426               case 's':                 /* Short form, don't wait for stats */
2427                 numstats = 0;
2428                 break;
2429               case 'w':                 /* Time to wait for packet arrival */
2430                 if (arg && isdigit(*arg)) {
2431                     timeout = atoi(arg);
2432                     if (timeout < 1) timeout = 1;
2433                     if (arg == argv[0]) argv++, argc--;
2434                     break;
2435                 } else
2436                     usage();
2437               case 'f':                 /* first hop */
2438                 if (arg && isdigit(*arg)) {
2439                     qno = atoi(arg);
2440                     if (qno > MAXHOPS) qno = MAXHOPS;
2441                     else if (qno < 1) qno = 0;
2442                     if (arg == argv[0]) argv++, argc--;
2443                     fflag++;
2444                     break;
2445                 } else
2446                     usage();
2447               case 'm':                 /* Max number of hops to trace */
2448                 if (arg && isdigit(*arg)) {
2449                     qno = atoi(arg);
2450                     if (qno > MAXHOPS) qno = MAXHOPS;
2451                     else if (qno < 1) qno = 0;
2452                     if (arg == argv[0]) argv++, argc--;
2453                     break;
2454                 } else
2455                     usage();
2456               case 'q':                 /* Number of query retries */
2457                 if (arg && isdigit(*arg)) {
2458                     nqueries = atoi(arg);
2459                     if (nqueries < 1) nqueries = 1;
2460                     if (arg == argv[0]) argv++, argc--;
2461                     break;
2462                 } else
2463                     usage();
2464               case 'g':                 /* Last-hop gateway (dest of query) */
2465                 if (arg && (gwy = host_addr(arg))) {
2466                     if (arg == argv[0]) argv++, argc--;
2467                     break;
2468                 } else
2469                     usage();
2470               case 't':                 /* TTL for query packet */
2471                 if (arg && isdigit(*arg)) {
2472                     qttl = atoi(arg);
2473                     if (qttl < 1) qttl = 1;
2474                     rttl = qttl;
2475                     if (arg == argv[0]) argv++, argc--;
2476                     break;
2477                 } else
2478                     usage();
2479               case 'e':                 /* Extra hops past non-responder */
2480                 if (arg && isdigit(*arg)) {
2481                     extrahops = atoi(arg);
2482                     if (extrahops < 0) extrahops = 0;
2483                     if (arg == argv[0]) argv++, argc--;
2484                     break;
2485                 } else
2486                     usage();
2487               case 'r':                 /* Dest for response packet */
2488                 if (arg && (raddr = host_addr(arg))) {
2489                     if (arg == argv[0]) argv++, argc--;
2490                     break;
2491                 } else
2492                     usage();
2493               case 'i':                 /* Local interface address */
2494                 if (arg && (lcl_addr = host_addr(arg))) {
2495                     if (arg == argv[0]) argv++, argc--;
2496                     break;
2497                 } else
2498                     usage();
2499               case 'S':                 /* Stat accumulation interval */
2500                 if (arg && isdigit(*arg)) {
2501                     statint = atoi(arg);
2502                     if (statint < 1) statint = 1;
2503                     if (arg == argv[0]) argv++, argc--;
2504                     break;
2505                 } else
2506                     usage();
2507               default:
2508                 usage();
2509             }
2510         } while (*p);
2511     }
2512
2513     if (argc > 0 && (qsrc = host_addr(argv[0]))) {          /* Source of path */
2514         if (IN_MULTICAST(ntohl(qsrc))) {
2515             if (gwy) {
2516                 /* Should probably rewrite arg parsing at some point, as
2517                  * this makes "mtrace -g foo 224.1.2.3 224.2.3.4" valid!... */
2518                 qgrp = qsrc;
2519                 qsrc = 0;
2520             } else {
2521                 usage();
2522             }
2523         }
2524         argv++, argc--;
2525         if (argc > 0 && (qdst = host_addr(argv[0]))) {      /* Dest of path */
2526             argv++, argc--;
2527             if (argc > 0 && (qgrp = host_addr(argv[0]))) {  /* Path via group */
2528                 argv++, argc--;
2529             }
2530             if (IN_MULTICAST(ntohl(qdst))) {
2531                 u_int32 temp = qdst;
2532                 qdst = qgrp;
2533                 qgrp = temp;
2534                 if (IN_MULTICAST(ntohl(qdst))) usage();
2535             } else if (qgrp && !IN_MULTICAST(ntohl(qgrp))) usage();
2536         }
2537     }
2538
2539     if (passive) {
2540         passive_mode();
2541         return(0);
2542     }
2543
2544     if (argc > 0) {
2545         usage();
2546     }
2547
2548 #ifdef SUNOS5
2549     if (sendopts)
2550         checkforsolarisbug();
2551 #endif
2552
2553     /*
2554      * Set useful defaults for as many parameters as possible.
2555      */
2556
2557     defgrp = 0;                         /* Default to no group */
2558     query_cast = htonl(0xE0000002);     /* All routers multicast addr */
2559     resp_cast = htonl(0xE0000120);      /* Mtrace response multicast addr */
2560     if (qgrp == 0) {
2561         if (!weak)
2562             qgrp = defgrp;
2563         if (printstats && numstats != 0 && !tunstats) {
2564             /* Stats are useless without a group */
2565             warnx(
2566         "WARNING: no multicast group specified, so no statistics printed");
2567             numstats = 0;
2568         }
2569     } else {
2570         if (weak)
2571             warnx(
2572         "WARNING: group was specified so not performing \"weak\" mtrace");
2573     }
2574
2575     /*
2576      * Get default local address for multicasts to use in setting defaults.
2577      */
2578     addr.sin_family = AF_INET;
2579 #if (defined(BSD) && (BSD >= 199103))
2580     addr.sin_len = sizeof(addr);
2581 #endif
2582     addr.sin_addr.s_addr = qgrp ? qgrp : query_cast;
2583     addr.sin_port = htons(2000);        /* Any port above 1024 will do */
2584
2585     /*
2586      * Note that getsockname() can return 0 on some systems
2587      * (notably SunOS 5.x, x < 6).  This is taken care of in
2588      * get_netmask().  If the default multicast interface (set
2589      * with the route for 224.0.0.0) is not the same as the
2590      * hostname, mtrace -i [if_addr] will have to be used.
2591      */
2592     if (((udp = socket(AF_INET, SOCK_DGRAM, 0)) < 0) ||
2593         (connect(udp, (struct sockaddr *) &addr, sizeof(addr)) < 0) ||
2594         getsockname(udp, (struct sockaddr *) &addr, &addrlen) < 0)
2595         err(-1, "determining local address");
2596
2597 #ifdef SUNOS5
2598     /*
2599      * SunOS 5.X prior to SunOS 2.6, getsockname returns 0 for udp socket.
2600      * This call to sysinfo will return the hostname.
2601      * If the default multicast interfface (set with the route
2602      * for 224.0.0.0) is not the same as the hostname,
2603      * mtrace -i [if_addr] will have to be used.
2604      */
2605     if (addr.sin_addr.s_addr == 0) {
2606         char myhostname[MAXHOSTNAMELEN];
2607         struct hostent *hp;
2608         int error;
2609     
2610         error = sysinfo(SI_HOSTNAME, myhostname, sizeof(myhostname));
2611         if (error == -1)
2612             err(1, "getting my hostname");
2613
2614         hp = gethostbyname(myhostname);
2615         if (hp == NULL || hp->h_addrtype != AF_INET ||
2616             hp->h_length != sizeof(addr.sin_addr))
2617             err(1, "finding IP address for my hostname");
2618
2619         memcpy((char *)&addr.sin_addr.s_addr, hp->h_addr, hp->h_length);
2620     }
2621 #endif
2622
2623     /*
2624      * Default destination for path to be queried is the local host.
2625      * When gateway specified, default destination is that gateway
2626      *  and default source is local host.
2627      */
2628     if (qdst == 0) {
2629         qdst = lcl_addr ? lcl_addr : addr.sin_addr.s_addr;
2630         dst_netmask = get_netmask(udp, &qdst);
2631         if (gwy && (gwy & dst_netmask) != (qdst & dst_netmask) &&
2632                 !IN_MULTICAST(ntohl(gwy)))
2633             qdst = gwy;
2634     }
2635     if (qsrc == 0 && gwy)
2636         qsrc = lcl_addr ? lcl_addr : addr.sin_addr.s_addr;
2637     if (qsrc == 0)
2638         usage();
2639     if (!dst_netmask)
2640         dst_netmask = get_netmask(udp, &qdst);
2641     close(udp);
2642     if (lcl_addr == 0) lcl_addr = addr.sin_addr.s_addr;
2643
2644     /*
2645      * Initialize the seed for random query identifiers.
2646      */
2647     gettimeofday(&tv, 0);
2648     seed = tv.tv_usec ^ lcl_addr;
2649 #ifdef SYSV    
2650     srand48(seed);
2651 #endif
2652
2653     /*
2654      * Protect against unicast queries to mrouted versions that might crash.
2655      * Also use the obsolete "can mtrace" neighbor bit to warn about
2656      * older implementations.
2657      */
2658     if (gwy && !IN_MULTICAST(ntohl(gwy)))
2659       if (send_recv(gwy, IGMP_DVMRP, DVMRP_ASK_NEIGHBORS2, 1, &incr[0], NULL)) {
2660         int flags = ntohl(incr[0].igmp.igmp_group.s_addr);
2661         int version = flags & 0xFFFF;
2662         int info = (flags & 0xFF0000) >> 16;
2663
2664         if (version == 0x0303 || version == 0x0503) {
2665             printf("Don't use -g to address an mrouted 3.%d, it might crash\n",
2666                    (version >> 8) & 0xFF);
2667             exit(0);
2668         }
2669         if ((info & 0x08) == 0) {
2670             printf("mtrace: ");
2671             print_host(gwy);
2672             printf(" probably doesn't support mtrace, trying anyway...\n");
2673         }
2674       }
2675
2676     printf("Mtrace from %s to %s via group %s\n",
2677            inet_fmt(qsrc, s1), inet_fmt(qdst, s2), inet_fmt(qgrp, s3));
2678
2679     if ((qdst & dst_netmask) == (qsrc & dst_netmask))
2680         fprintf(stderr, "mtrace: Source & receiver appear to be directly connected\n");
2681
2682     /*
2683      * If the response is to be a multicast address, make sure we 
2684      * are listening on that multicast address.
2685      */
2686     if (raddr) {
2687         if (IN_MULTICAST(ntohl(raddr))) k_join(raddr, lcl_addr);
2688     } else k_join(resp_cast, lcl_addr);
2689
2690     memset(&base, 0, sizeof(base));
2691
2692     /*
2693      * If the destination is on the local net, the last-hop router can
2694      * be found by multicast to the all-routers multicast group.
2695      * Otherwise, use the group address that is the subject of the
2696      * query since by definition the last-hop router will be a member.
2697      * Set default TTLs for local remote multicasts.
2698      */
2699     if (gwy == 0)
2700       if ((qdst & dst_netmask) == (lcl_addr & dst_netmask)) tdst = query_cast;
2701       else tdst = qgrp;
2702     else tdst = gwy;
2703     if (tdst == 0 && qgrp == 0)
2704         errx(1, "mtrace: weak mtrace requires -g if destination is not local.\n");
2705
2706     if (IN_MULTICAST(ntohl(tdst))) {
2707       k_set_loop(1);    /* If I am running on a router, I need to hear this */
2708       if (tdst == query_cast) k_set_ttl(qttl ? qttl : 1);
2709       else k_set_ttl(qttl ? qttl : MULTICAST_TTL1);
2710     }
2711
2712     /*
2713      * Try a query at the requested number of hops or MAXHOPS if unspecified.
2714      */
2715     if (qno == 0) {
2716         hops = MAXHOPS;
2717         tries = 1;
2718         printf("Querying full reverse path... ");
2719         fflush(stdout);
2720     } else {
2721         hops = qno;
2722         tries = nqueries;
2723         if (fflag)
2724             printf("Querying full reverse path, starting at hop %d...", qno);
2725         else
2726             printf("Querying reverse path, maximum %d hops... ", qno);
2727         fflush(stdout); 
2728     }
2729     base.rtime = 0;
2730     base.len = 0;
2731     hopbyhop = FALSE;
2732
2733     recvlen = send_recv(tdst, IGMP_MTRACE, hops, tries, &base, mtrace_callback);
2734
2735     /*
2736      * If the initial query was successful, print it.  Otherwise, if
2737      * the query max hop count is the default of zero, loop starting
2738      * from one until there is no response for extrahops more hops.  The
2739      * extra hops allow getting past an mtrace-capable mrouter that can't
2740      * send multicast packets because all phyints are disabled.
2741      */
2742     if (recvlen) {
2743         printf("\n  0  ");
2744         print_host(qdst);
2745         printf("\n");
2746         print_trace(1, &base, names);
2747         r = base.resps + base.len - 1;
2748         if (r->tr_rflags == TR_OLD_ROUTER || r->tr_rflags == TR_NO_SPACE ||
2749                 (qno != 0 && r->tr_rmtaddr != 0 && !fflag)) {
2750             printf("%3d  ", -(base.len+1));
2751             what_kind(&base, r->tr_rflags == TR_OLD_ROUTER ?
2752                                    "doesn't support mtrace"
2753                                  : "is the next hop");
2754         } else {
2755             if (fflag) {
2756                 nexthop = hops = qno;
2757                 goto continuehop;
2758             }
2759             VAL_TO_MASK(smask, r->tr_smask);
2760             if ((r->tr_inaddr & smask) == (qsrc & smask)) {
2761                 printf("%3d  ", -(base.len+1));
2762                 print_host(qsrc);
2763                 printf("\n");
2764             }
2765         }
2766     } else if (qno == 0) {
2767         hopbyhop = TRUE;
2768         printf("switching to hop-by-hop:\n  0  ");
2769         print_host(qdst);
2770         printf("\n");
2771
2772         for (hops = 1, nexthop = 1; hops <= MAXHOPS; ++hops) {
2773             printf("%3d  ", -hops);
2774             fflush(stdout);
2775
2776             /*
2777              * After a successful first hop, try switching to the unicast
2778              * address of the last-hop router instead of multicasting the
2779              * trace query.  This should be safe for mrouted versions 3.3
2780              * and 3.5 because there is a long route timeout with metric
2781              * infinity before a route disappears.  Switching to unicast
2782              * reduces the amount of multicast traffic and avoids a bug
2783              * with duplicate suppression in mrouted 3.5.
2784              */
2785             if (hops == 2 && gwy == 0 && lastout != 0 &&
2786                 (recvlen = send_recv(lastout, IGMP_MTRACE, hops, 1, &base, mtrace_callback)))
2787               tdst = lastout;
2788             else recvlen = send_recv(tdst, IGMP_MTRACE, hops, nqueries, &base, mtrace_callback);
2789
2790             if (recvlen == 0) {
2791                 /*if (hops == 1) break;*/
2792                 if (hops == nexthop) {
2793                     if (hops == 1) {
2794                         printf("\n");
2795                     } else if (what_kind(&base, "didn't respond")) {
2796                         /* the ask_neighbors determined that the
2797                          * not-responding router is the first-hop. */
2798                         break;
2799                     }
2800                     if (extrahops == 0)
2801                         break;
2802                 } else if (hops < nexthop + extrahops) {
2803                     printf("\n");
2804                 } else {
2805                     printf("...giving up\n");
2806                     break;
2807                 }
2808                 continue;
2809             }
2810             if (base.len == hops &&
2811                 (hops == 1 || (base.resps+nexthop-2)->tr_outaddr == lastout)) {
2812                 if (hops == nexthop) {
2813                     print_trace(-hops, &base, names);
2814                 } else {
2815                     printf("\nResuming...\n");
2816                     print_trace(nexthop, &base, names);
2817                 }
2818             } else {
2819                 if (base.len < hops) {
2820                     /*
2821                      * A shorter trace than requested means a fatal error
2822                      * occurred along the path, or that the route changed
2823                      * to a shorter one.
2824                      *
2825                      * If the trace is longer than the last one we received,
2826                      * then we are resuming from a skipped router (but there
2827                      * is still probably a problem).
2828                      *
2829                      * If the trace is shorter than the last one we
2830                      * received, then the route must have changed (and
2831                      * there is still probably a problem).
2832                      */
2833                     if (nexthop <= base.len) {
2834                         printf("\nResuming...\n");
2835                         print_trace(nexthop, &base, names);
2836                     } else if (nexthop > base.len + 1) {
2837                         hops = base.len;
2838                         printf("\nRoute must have changed...\n");
2839                         print_trace(1, &base, names);
2840                     }
2841                 } else {
2842                     /*
2843                      * The last hop address is not the same as it was.
2844                      * If we didn't know the last hop then we just
2845                      * got the first response from a hop-by-hop trace;
2846                      * if we did know the last hop then
2847                      * the route probably changed underneath us.
2848                      */
2849                     hops = base.len;
2850                     if (lastout != 0)
2851                         printf("\nRoute must have changed...\n");
2852                     else
2853                         printf("\nResuming...\n");
2854                     print_trace(1, &base, names);
2855                 }
2856             }
2857 continuehop:
2858             r = base.resps + base.len - 1;
2859             lastout = r->tr_outaddr;
2860
2861             if (base.len < hops ||
2862                 r->tr_rmtaddr == 0 ||
2863                 (r->tr_rflags & 0x80)) {
2864                 VAL_TO_MASK(smask, r->tr_smask);
2865                 if (r->tr_rmtaddr) {
2866                     if (hops != nexthop) {
2867                         printf("\n%3d  ", -(base.len+1));
2868                     }
2869                     what_kind(&base, r->tr_rflags == TR_OLD_ROUTER ?
2870                                 "doesn't support mtrace" :
2871                                 "would be the next hop");
2872                     /* XXX could do segmented trace if TR_NO_SPACE */
2873                 } else if (r->tr_rflags == TR_NO_ERR &&
2874                            (r->tr_inaddr & smask) == (qsrc & smask)) {
2875                     printf("%3d  ", -(hops + 1));
2876                     print_host(qsrc);
2877                     printf("\n");
2878                 }
2879                 break;
2880             }
2881
2882             nexthop = hops + 1;
2883         }
2884     }
2885
2886     if (base.rtime == 0) {
2887         printf("Timed out receiving responses\n");
2888         if (IN_MULTICAST(ntohl(tdst))){
2889           if (tdst == query_cast)
2890             printf("Perhaps no local router has a route for source %s\n",
2891                    inet_fmt(qsrc, s1));
2892           else
2893             printf("Perhaps receiver %s is not a member of group %s,\n\
2894 or no router local to it has a route for source %s,\n\
2895 or multicast at ttl %d doesn't reach its last-hop router for that source\n",
2896                    inet_fmt(qdst, s2), inet_fmt(qgrp, s3), inet_fmt(qsrc, s1),
2897                    qttl ? qttl : MULTICAST_TTL1);
2898         }
2899         exit(1);
2900     }
2901
2902     printf("Round trip time %d ms; ", t_diff(base.rtime, base.qtime));
2903     {
2904         struct tr_resp *n = base.resps + base.len - 1;
2905         u_int ttl = n->tr_fttl + 1;
2906
2907         rno = base.len - 1;
2908         while (--rno > 0) {
2909             --n;
2910             ttl = MaX(ttl, MaX(1, n->tr_fttl) + base.len - rno);
2911         }
2912         printf("total ttl of %d required.\n\n",ttl);
2913     }
2914
2915     /*
2916      * Use the saved response which was the longest one received,
2917      * and make additional probes after delay to measure loss.
2918      */
2919     raddr = base.qhdr.tr_raddr;
2920     rttl = TR_GETTTL(base.qhdr.tr_rttlqid);
2921     gettimeofday(&tv, 0);
2922     waittime = statint - (((tv.tv_sec + JAN_1970) & 0xFFFF) - (base.qtime >> 16));
2923     prev = &base;
2924     new = &incr[numstats&1];
2925
2926     /*
2927      * Zero out bug-avoidance counters
2928      */
2929     memset(bugs, 0, sizeof(bugs));
2930
2931     if (!printstats)
2932         printf("Monitoring path..");
2933
2934     while (numstats--) {
2935         if (waittime < 1) printf("\n");
2936         else {
2937             if (printstats && (lossthresh == 0 || printed)) {
2938                 printf("Waiting to accumulate statistics...");
2939             } else {
2940                 printf(".");
2941             }
2942             fflush(stdout);
2943             sleep((unsigned)waittime);
2944         }
2945         printed = 0;
2946         rno = hopbyhop ? base.len : qno ? qno : MAXHOPS;
2947         recvlen = send_recv(tdst, IGMP_MTRACE, rno, nqueries, new, mtrace_callback);
2948
2949         if (recvlen == 0) {
2950             printf("Timed out.\n");
2951             if (numstats) {
2952                 numstats++;
2953                 continue;
2954             } else
2955                 exit(1);
2956         }
2957
2958         if (base.len != new->len || path_changed(&base, new)) {
2959             printf("%s", base.len == new->len ? "Route changed" :
2960                                         "Trace length doesn't match");
2961             if (!printstats)
2962                 printf(" after %d seconds",
2963                    (int)((new->qtime - base.qtime) >> 16));
2964             printf(":\n");
2965 printandcontinue:
2966             print_trace(1, new, names);
2967             numstats++;
2968             bcopy(new, &base, sizeof(base));
2969             nexthop = hops = new->len;
2970             printf("Continuing with hop-by-hop...\n");
2971             goto continuehop;
2972         }
2973
2974         if (printstats) {
2975             if (new->igmp.igmp_group.s_addr != qgrp ||
2976                 new->qhdr.tr_src != qsrc || new->qhdr.tr_dst != qdst)
2977                 printf("\nWARNING: trace modified en route; statistics may be incorrect\n");
2978             fixup_stats(&base, prev, new, bugs);
2979             if ((lossthresh == 0) || check_thresh(lossthresh, &base, prev, new)) {
2980                 printf("Results after %d seconds",
2981                        (int)((new->qtime - base.qtime) >> 16));
2982                 if (lossthresh)
2983                     printf(" (this trace %d seconds)",
2984                            (int)((new->qtime - prev->qtime) >> 16));
2985                 if (verbose) {
2986                     time_t t = time(0);
2987                     struct tm *qr = localtime(&t);
2988
2989                     printf(" qid 0x%06x at %2d:%02d:%02d",
2990                                 TR_GETQID(base.qhdr.tr_rttlqid),
2991                                 qr->tm_hour, qr->tm_min, qr->tm_sec);
2992                 }
2993                 printf(":\n\n");
2994                 printed = 1;
2995                 if (print_stats(&base, prev, new, bugs, names)) {
2996                     printf("This should have been detected earlier, but ");
2997                     printf("Route changed:\n");
2998                     goto printandcontinue;
2999                 }
3000             }
3001         }
3002         prev = new;
3003         new = &incr[numstats&1];
3004         waittime = statint;
3005     }
3006
3007     /*
3008      * If the response was multicast back, leave the group
3009      */
3010     if (raddr) {
3011         if (IN_MULTICAST(ntohl(raddr))) k_leave(raddr, lcl_addr);
3012     } else k_leave(resp_cast, lcl_addr);
3013
3014     return (0);
3015 }
3016
3017 static void
3018 usage(void)
3019 {
3020         fprintf(stderr, "%s\n%s\n%s\n",
3021         "usage: mtrace [-MUOPTWVlnpvs] [-e extra_hops] [-f first_hop] [-i if_addr]",
3022         "              [-g gateway] [-m max_hops] [-q nqueries] [-r resp_dest]",
3023         "              [-S statint] [-t ttl] [-w wait] source [receiver] [group]");
3024         exit(1);
3025 }
3026
3027 void
3028 check_vif_state(void)
3029 {
3030     dolog(LOG_WARNING, errno, "sendto");
3031 }
3032
3033 /*
3034  * Log errors and other messages to stderr, according to the severity
3035  * of the message and the current debug level.  For errors of severity
3036  * LOG_ERR or worse, terminate the program.
3037  */
3038 void
3039 dolog(int severity, int syserr, char *format, ...)
3040 {
3041         va_list ap;
3042         char    fmt[100];
3043
3044         va_start(ap, format);
3045
3046     switch (debug) {
3047         case 0: if (severity > LOG_WARNING) return;
3048         case 1: if (severity > LOG_NOTICE) return;
3049         case 2: if (severity > LOG_INFO  ) return;
3050         default:
3051             fmt[0] = '\0';
3052             if (severity == LOG_WARNING) 
3053                 strcpy(fmt, "warning - ");
3054             strncat(fmt, format, sizeof(fmt)-strlen(fmt));
3055             fmt[sizeof(fmt)-1]='\0';
3056             vfprintf(stderr, fmt, ap);
3057             if (syserr == 0)
3058                 fprintf(stderr, "\n");
3059             else if (syserr < sys_nerr)
3060                 fprintf(stderr, ": %s\n", sys_errlist[syserr]);
3061             else
3062                 fprintf(stderr, ": errno %d\n", syserr);
3063     }
3064     if (severity <= LOG_ERR) exit(1);
3065 }