Import tcpdump-4.3.0.
[dragonfly.git] / contrib / tcpdump / print-pim.c
1 /*
2  * Copyright (c) 1995, 1996
3  *      The Regents of the University of California.  All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that: (1) source code distributions
7  * retain the above copyright notice and this paragraph in its entirety, (2)
8  * distributions including binary code include the above copyright notice and
9  * this paragraph in its entirety in the documentation or other materials
10  * provided with the distribution, and (3) all advertising materials mentioning
11  * features or use of this software display the following acknowledgement:
12  * ``This product includes software developed by the University of California,
13  * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
14  * the University nor the names of its contributors may be used to endorse
15  * or promote products derived from this software without specific prior
16  * written permission.
17  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
18  * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
19  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
20  */
21
22 #ifndef lint
23 static const char rcsid[] _U_ =
24     "@(#) $Header: /tcpdump/master/tcpdump/print-pim.c,v 1.49 2006-02-13 01:31:35 hannes Exp $ (LBL)";
25 #endif
26
27 #ifdef HAVE_CONFIG_H
28 #include "config.h"
29 #endif
30
31 #include <tcpdump-stdinc.h>
32
33 #include <stdio.h>
34 #include <stdlib.h>
35
36 #include "interface.h"
37 #include "addrtoname.h"
38 #include "extract.h"
39
40 #include "ip.h"
41
42 #define PIMV2_TYPE_HELLO         0
43 #define PIMV2_TYPE_REGISTER      1
44 #define PIMV2_TYPE_REGISTER_STOP 2
45 #define PIMV2_TYPE_JOIN_PRUNE    3
46 #define PIMV2_TYPE_BOOTSTRAP     4
47 #define PIMV2_TYPE_ASSERT        5
48 #define PIMV2_TYPE_GRAFT         6
49 #define PIMV2_TYPE_GRAFT_ACK     7
50 #define PIMV2_TYPE_CANDIDATE_RP  8
51 #define PIMV2_TYPE_PRUNE_REFRESH 9
52
53 static struct tok pimv2_type_values[] = {
54     { PIMV2_TYPE_HELLO,         "Hello" },
55     { PIMV2_TYPE_REGISTER,      "Register" },
56     { PIMV2_TYPE_REGISTER_STOP, "Register Stop" },
57     { PIMV2_TYPE_JOIN_PRUNE,    "Join / Prune" },
58     { PIMV2_TYPE_BOOTSTRAP,     "Bootstrap" },
59     { PIMV2_TYPE_ASSERT,        "Assert" },
60     { PIMV2_TYPE_GRAFT,         "Graft" },
61     { PIMV2_TYPE_GRAFT_ACK,     "Graft Acknowledgement" },
62     { PIMV2_TYPE_CANDIDATE_RP,  "Candidate RP Advertisement" },
63     { PIMV2_TYPE_PRUNE_REFRESH, "Prune Refresh" },
64     { 0, NULL}
65 };
66
67 #define PIMV2_HELLO_OPTION_HOLDTIME             1
68 #define PIMV2_HELLO_OPTION_LANPRUNEDELAY        2
69 #define PIMV2_HELLO_OPTION_DR_PRIORITY_OLD     18
70 #define PIMV2_HELLO_OPTION_DR_PRIORITY         19
71 #define PIMV2_HELLO_OPTION_GENID               20
72 #define PIMV2_HELLO_OPTION_REFRESH_CAP         21
73 #define PIMV2_HELLO_OPTION_BIDIR_CAP           22
74 #define PIMV2_HELLO_OPTION_ADDRESS_LIST        24
75 #define PIMV2_HELLO_OPTION_ADDRESS_LIST_OLD 65001
76
77 static struct tok pimv2_hello_option_values[] = {
78     { PIMV2_HELLO_OPTION_HOLDTIME,         "Hold Time" },
79     { PIMV2_HELLO_OPTION_LANPRUNEDELAY,    "LAN Prune Delay" },
80     { PIMV2_HELLO_OPTION_DR_PRIORITY_OLD,  "DR Priority (Old)" },
81     { PIMV2_HELLO_OPTION_DR_PRIORITY,      "DR Priority" },
82     { PIMV2_HELLO_OPTION_GENID,            "Generation ID" },
83     { PIMV2_HELLO_OPTION_REFRESH_CAP,      "State Refresh Capability" },
84     { PIMV2_HELLO_OPTION_BIDIR_CAP,        "Bi-Directional Capability" },
85     { PIMV2_HELLO_OPTION_ADDRESS_LIST,     "Address List" },
86     { PIMV2_HELLO_OPTION_ADDRESS_LIST_OLD, "Address List (Old)" },
87     { 0, NULL}
88 };
89
90 #define PIMV2_REGISTER_FLAG_LEN      4
91 #define PIMV2_REGISTER_FLAG_BORDER 0x80000000
92 #define PIMV2_REGISTER_FLAG_NULL   0x40000000
93
94 static struct tok pimv2_register_flag_values[] = {
95     { PIMV2_REGISTER_FLAG_BORDER, "Border" },
96     { PIMV2_REGISTER_FLAG_NULL, "Null" },
97     { 0, NULL}
98 };    
99
100 /*
101  * XXX: We consider a case where IPv6 is not ready yet for portability,
102  * but PIM dependent defintions should be independent of IPv6...
103  */
104
105 struct pim {
106         u_int8_t pim_typever;
107                         /* upper 4bit: PIM version number; 2 for PIMv2 */
108                         /* lower 4bit: the PIM message type, currently they are:
109                          * Hello, Register, Register-Stop, Join/Prune,
110                          * Bootstrap, Assert, Graft (PIM-DM only),
111                          * Graft-Ack (PIM-DM only), C-RP-Adv
112                          */
113 #define PIM_VER(x)      (((x) & 0xf0) >> 4)
114 #define PIM_TYPE(x)     ((x) & 0x0f)
115         u_char  pim_rsv;        /* Reserved */
116         u_short pim_cksum;      /* IP style check sum */
117 };
118
119 static void pimv2_print(register const u_char *bp, register u_int len, u_int cksum);
120
121 static void
122 pimv1_join_prune_print(register const u_char *bp, register u_int len)
123 {
124         int maddrlen, addrlen, ngroups, njoin, nprune;
125         int njp;
126
127         /* If it's a single group and a single source, use 1-line output. */
128         if (TTEST2(bp[0], 30) && bp[11] == 1 &&
129             ((njoin = EXTRACT_16BITS(&bp[20])) + EXTRACT_16BITS(&bp[22])) == 1) {
130                 int hold;
131
132                 (void)printf(" RPF %s ", ipaddr_string(bp));
133                 hold = EXTRACT_16BITS(&bp[6]);
134                 if (hold != 180) {
135                         (void)printf("Hold ");
136                         relts_print(hold);
137                 }
138                 (void)printf("%s (%s/%d, %s", njoin ? "Join" : "Prune",
139                 ipaddr_string(&bp[26]), bp[25] & 0x3f,
140                 ipaddr_string(&bp[12]));
141                 if (EXTRACT_32BITS(&bp[16]) != 0xffffffff)
142                         (void)printf("/%s", ipaddr_string(&bp[16]));
143                 (void)printf(") %s%s %s",
144                     (bp[24] & 0x01) ? "Sparse" : "Dense",
145                     (bp[25] & 0x80) ? " WC" : "",
146                     (bp[25] & 0x40) ? "RP" : "SPT");
147                 return;
148         }
149
150         TCHECK2(bp[0], sizeof(struct in_addr));
151         if (vflag > 1)
152                 (void)printf("\n");
153         (void)printf(" Upstream Nbr: %s", ipaddr_string(bp));
154         TCHECK2(bp[6], 2);
155         if (vflag > 1)
156                 (void)printf("\n");
157         (void)printf(" Hold time: ");
158         relts_print(EXTRACT_16BITS(&bp[6]));
159         if (vflag < 2)
160                 return;
161         bp += 8;
162         len -= 8;
163
164         TCHECK2(bp[0], 4);
165         maddrlen = bp[1];
166         addrlen = bp[2];
167         ngroups = bp[3];
168         bp += 4;
169         len -= 4;
170         while (ngroups--) {
171                 /*
172                  * XXX - does the address have length "addrlen" and the
173                  * mask length "maddrlen"?
174                  */
175                 TCHECK2(bp[0], sizeof(struct in_addr));
176                 (void)printf("\n\tGroup: %s", ipaddr_string(bp));
177                 TCHECK2(bp[4], sizeof(struct in_addr));
178                 if (EXTRACT_32BITS(&bp[4]) != 0xffffffff)
179                         (void)printf("/%s", ipaddr_string(&bp[4]));
180                 TCHECK2(bp[8], 4);
181                 njoin = EXTRACT_16BITS(&bp[8]);
182                 nprune = EXTRACT_16BITS(&bp[10]);
183                 (void)printf(" joined: %d pruned: %d", njoin, nprune);
184                 bp += 12;
185                 len -= 12;
186                 for (njp = 0; njp < (njoin + nprune); njp++) {
187                         const char *type;
188
189                         if (njp < njoin)
190                                 type = "Join ";
191                         else
192                                 type = "Prune";
193                         TCHECK2(bp[0], 6);
194                         (void)printf("\n\t%s %s%s%s%s/%d", type,
195                             (bp[0] & 0x01) ? "Sparse " : "Dense ",
196                             (bp[1] & 0x80) ? "WC " : "",
197                             (bp[1] & 0x40) ? "RP " : "SPT ",
198                         ipaddr_string(&bp[2]), bp[1] & 0x3f);
199                         bp += 6;
200                         len -= 6;
201                 }
202         }
203         return;
204 trunc:
205         (void)printf("[|pim]");
206         return;
207 }
208
209 void
210 pimv1_print(register const u_char *bp, register u_int len)
211 {
212         register const u_char *ep;
213         register u_char type;
214
215         ep = (const u_char *)snapend;
216         if (bp >= ep)
217                 return;
218
219         TCHECK(bp[1]);
220         type = bp[1];
221
222         switch (type) {
223         case 0:
224                 (void)printf(" Query");
225                 if (TTEST(bp[8])) {
226                         switch (bp[8] >> 4) {
227                         case 0:
228                                 (void)printf(" Dense-mode");
229                                 break;
230                         case 1:
231                                 (void)printf(" Sparse-mode");
232                                 break;
233                         case 2:
234                                 (void)printf(" Sparse-Dense-mode");
235                                 break;
236                         default:
237                                 (void)printf(" mode-%d", bp[8] >> 4);
238                                 break;
239                         }
240                 }
241                 if (vflag) {
242                         TCHECK2(bp[10],2);
243                         (void)printf(" (Hold-time ");
244                         relts_print(EXTRACT_16BITS(&bp[10]));
245                         (void)printf(")");
246                 }
247                 break;
248
249         case 1:
250                 (void)printf(" Register");
251                 TCHECK2(bp[8], 20);                     /* ip header */
252                 (void)printf(" for %s > %s", ipaddr_string(&bp[20]),
253                     ipaddr_string(&bp[24]));
254                 break;
255         case 2:
256                 (void)printf(" Register-Stop");
257                 TCHECK2(bp[12], sizeof(struct in_addr));
258                 (void)printf(" for %s > %s", ipaddr_string(&bp[8]),
259                     ipaddr_string(&bp[12]));
260                 break;
261         case 3:
262                 (void)printf(" Join/Prune");
263                 if (vflag)
264                         pimv1_join_prune_print(&bp[8], len - 8);
265                 break;
266         case 4:
267                 (void)printf(" RP-reachable");
268                 if (vflag) {
269                         TCHECK2(bp[22], 2);
270                         (void)printf(" group %s",
271                         ipaddr_string(&bp[8]));
272                         if (EXTRACT_32BITS(&bp[12]) != 0xffffffff)
273                                 (void)printf("/%s", ipaddr_string(&bp[12]));
274                         (void)printf(" RP %s hold ", ipaddr_string(&bp[16]));
275                         relts_print(EXTRACT_16BITS(&bp[22]));
276                 }
277                 break;
278         case 5:
279                 (void)printf(" Assert");
280                 TCHECK2(bp[16], sizeof(struct in_addr));
281                 (void)printf(" for %s > %s", ipaddr_string(&bp[16]),
282                     ipaddr_string(&bp[8]));
283                 if (EXTRACT_32BITS(&bp[12]) != 0xffffffff)
284                         (void)printf("/%s", ipaddr_string(&bp[12]));
285                 TCHECK2(bp[24], 4);
286                 (void)printf(" %s pref %d metric %d",
287                     (bp[20] & 0x80) ? "RP-tree" : "SPT",
288                 EXTRACT_32BITS(&bp[20]) & 0x7fffffff,
289                 EXTRACT_32BITS(&bp[24]));
290                 break;
291         case 6:
292                 (void)printf(" Graft");
293                 if (vflag)
294                         pimv1_join_prune_print(&bp[8], len - 8);
295                 break;
296         case 7:
297                 (void)printf(" Graft-ACK");
298                 if (vflag)
299                         pimv1_join_prune_print(&bp[8], len - 8);
300                 break;
301         case 8:
302                 (void)printf(" Mode");
303                 break;
304         default:
305                 (void)printf(" [type %d]", type);
306                 break;
307         }
308         if ((bp[4] >> 4) != 1)
309                 (void)printf(" [v%d]", bp[4] >> 4);
310         return;
311
312 trunc:
313         (void)printf("[|pim]");
314         return;
315 }
316
317 /*
318  * auto-RP is a cisco protocol, documented at
319  * ftp://ftpeng.cisco.com/ipmulticast/specs/pim-autorp-spec01.txt
320  *
321  * This implements version 1+, dated Sept 9, 1998.
322  */
323 void
324 cisco_autorp_print(register const u_char *bp, register u_int len)
325 {
326         int type;
327         int numrps;
328         int hold;
329
330         TCHECK(bp[0]);
331         (void)printf(" auto-rp ");
332         type = bp[0];
333         switch (type) {
334         case 0x11:
335                 (void)printf("candidate-advert");
336                 break;
337         case 0x12:
338                 (void)printf("mapping");
339                 break;
340         default:
341                 (void)printf("type-0x%02x", type);
342                 break;
343         }
344
345         TCHECK(bp[1]);
346         numrps = bp[1];
347
348         TCHECK2(bp[2], 2);
349         (void)printf(" Hold ");
350         hold = EXTRACT_16BITS(&bp[2]);
351         if (hold)
352                 relts_print(EXTRACT_16BITS(&bp[2]));
353         else
354                 printf("FOREVER");
355
356         /* Next 4 bytes are reserved. */
357
358         bp += 8; len -= 8;
359
360         /*XXX skip unless -v? */
361
362         /*
363          * Rest of packet:
364          * numrps entries of the form:
365          * 32 bits: RP
366          * 6 bits: reserved
367          * 2 bits: PIM version supported, bit 0 is "supports v1", 1 is "v2".
368          * 8 bits: # of entries for this RP
369          * each entry: 7 bits: reserved, 1 bit: negative,
370          *             8 bits: mask 32 bits: source
371          * lather, rinse, repeat.
372          */
373         while (numrps--) {
374                 int nentries;
375                 char s;
376
377                 TCHECK2(bp[0], 4);
378                 (void)printf(" RP %s", ipaddr_string(bp));
379                 TCHECK(bp[4]);
380                 switch (bp[4] & 0x3) {
381                 case 0: printf(" PIMv?");
382                         break;
383                 case 1: printf(" PIMv1");
384                         break;
385                 case 2: printf(" PIMv2");
386                         break;
387                 case 3: printf(" PIMv1+2");
388                         break;
389                 }
390                 if (bp[4] & 0xfc)
391                         (void)printf(" [rsvd=0x%02x]", bp[4] & 0xfc);
392                 TCHECK(bp[5]);
393                 nentries = bp[5];
394                 bp += 6; len -= 6;
395                 s = ' ';
396                 for (; nentries; nentries--) {
397                         TCHECK2(bp[0], 6);
398                         (void)printf("%c%s%s/%d", s, bp[0] & 1 ? "!" : "",
399                             ipaddr_string(&bp[2]), bp[1]);
400                         if (bp[0] & 0x02) {
401                             (void)printf(" bidir");
402                         }
403                         if (bp[0] & 0xfc) {
404                             (void)printf("[rsvd=0x%02x]", bp[0] & 0xfc);
405                         }
406                         s = ',';
407                         bp += 6; len -= 6;
408                 }
409         }
410         return;
411
412 trunc:
413         (void)printf("[|autorp]");
414         return;
415 }
416
417 void
418 pim_print(register const u_char *bp, register u_int len, u_int cksum)
419 {
420         register const u_char *ep;
421         register struct pim *pim = (struct pim *)bp;
422
423         ep = (const u_char *)snapend;
424         if (bp >= ep)
425                 return;
426 #ifdef notyet                   /* currently we see only version and type */
427         TCHECK(pim->pim_rsv);
428 #endif
429
430         switch (PIM_VER(pim->pim_typever)) {
431         case 2:
432             if (!vflag) {
433                 printf("PIMv%u, %s, length %u",
434                        PIM_VER(pim->pim_typever),
435                        tok2str(pimv2_type_values,"Unknown Type",PIM_TYPE(pim->pim_typever)),
436                        len);
437                 return;
438             } else {
439                 printf("PIMv%u, length %u\n\t%s",
440                        PIM_VER(pim->pim_typever),
441                        len,
442                        tok2str(pimv2_type_values,"Unknown Type",PIM_TYPE(pim->pim_typever)));
443                 pimv2_print(bp, len, cksum);
444             }
445             break;
446         default:
447                 printf("PIMv%u, length %u",
448                        PIM_VER(pim->pim_typever),
449                        len);
450                 break;
451         }
452         return;
453 }
454
455 /*
456  * PIMv2 uses encoded address representations.
457  *
458  * The last PIM-SM I-D before RFC2117 was published specified the
459  * following representation for unicast addresses.  However, RFC2117
460  * specified no encoding for unicast addresses with the unicast
461  * address length specified in the header.  Therefore, we have to
462  * guess which encoding is being used (Cisco's PIMv2 implementation
463  * uses the non-RFC encoding).  RFC2117 turns a previously "Reserved"
464  * field into a 'unicast-address-length-in-bytes' field.  We guess
465  * that it's the draft encoding if this reserved field is zero.
466  *
467  * RFC2362 goes back to the encoded format, and calls the addr length
468  * field "reserved" again.
469  *
470  * The first byte is the address family, from:
471  *
472  *    0    Reserved
473  *    1    IP (IP version 4)
474  *    2    IP6 (IP version 6)
475  *    3    NSAP
476  *    4    HDLC (8-bit multidrop)
477  *    5    BBN 1822
478  *    6    802 (includes all 802 media plus Ethernet "canonical format")
479  *    7    E.163
480  *    8    E.164 (SMDS, Frame Relay, ATM)
481  *    9    F.69 (Telex)
482  *   10    X.121 (X.25, Frame Relay)
483  *   11    IPX
484  *   12    Appletalk
485  *   13    Decnet IV
486  *   14    Banyan Vines
487  *   15    E.164 with NSAP format subaddress
488  *
489  * In addition, the second byte is an "Encoding".  0 is the default
490  * encoding for the address family, and no other encodings are currently
491  * specified.
492  *
493  */
494
495 static int pimv2_addr_len;
496
497 enum pimv2_addrtype {
498         pimv2_unicast, pimv2_group, pimv2_source
499 };
500
501 /*  0                   1                   2                   3
502  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
503  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
504  * | Addr Family   | Encoding Type |     Unicast Address           |
505  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+++++++
506  *  0                   1                   2                   3
507  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
508  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
509  * | Addr Family   | Encoding Type |   Reserved    |  Mask Len     |
510  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
511  * |                Group multicast Address                        |
512  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
513  *  0                   1                   2                   3
514  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
515  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
516  * | Addr Family   | Encoding Type | Rsrvd   |S|W|R|  Mask Len     |
517  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
518  * |                        Source Address                         |
519  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
520  */
521 static int
522 pimv2_addr_print(const u_char *bp, enum pimv2_addrtype at, int silent)
523 {
524         int af;
525         int len, hdrlen;
526
527         TCHECK(bp[0]);
528
529         if (pimv2_addr_len == 0) {
530                 TCHECK(bp[1]);
531                 switch (bp[0]) {
532                 case 1:
533                         af = AF_INET;
534                         len = sizeof(struct in_addr);
535                         break;
536 #ifdef INET6
537                 case 2:
538                         af = AF_INET6;
539                         len = sizeof(struct in6_addr);
540                         break;
541 #endif
542                 default:
543                         return -1;
544                 }
545                 if (bp[1] != 0)
546                         return -1;
547                 hdrlen = 2;
548         } else {
549                 switch (pimv2_addr_len) {
550                 case sizeof(struct in_addr):
551                         af = AF_INET;
552                         break;
553 #ifdef INET6
554                 case sizeof(struct in6_addr):
555                         af = AF_INET6;
556                         break;
557 #endif
558                 default:
559                         return -1;
560                         break;
561                 }
562                 len = pimv2_addr_len;
563                 hdrlen = 0;
564         }
565
566         bp += hdrlen;
567         switch (at) {
568         case pimv2_unicast:
569                 TCHECK2(bp[0], len);
570                 if (af == AF_INET) {
571                         if (!silent)
572                                 (void)printf("%s", ipaddr_string(bp));
573                 }
574 #ifdef INET6
575                 else if (af == AF_INET6) {
576                         if (!silent)
577                                 (void)printf("%s", ip6addr_string(bp));
578                 }
579 #endif
580                 return hdrlen + len;
581         case pimv2_group:
582         case pimv2_source:
583                 TCHECK2(bp[0], len + 2);
584                 if (af == AF_INET) {
585                         if (!silent) {
586                                 (void)printf("%s", ipaddr_string(bp + 2));
587                                 if (bp[1] != 32)
588                                         (void)printf("/%u", bp[1]);
589                         }
590                 }
591 #ifdef INET6
592                 else if (af == AF_INET6) {
593                         if (!silent) {
594                                 (void)printf("%s", ip6addr_string(bp + 2));
595                                 if (bp[1] != 128)
596                                         (void)printf("/%u", bp[1]);
597                         }
598                 }
599 #endif
600                 if (bp[0] && !silent) {
601                         if (at == pimv2_group) {
602                                 (void)printf("(0x%02x)", bp[0]);
603                         } else {
604                                 (void)printf("(%s%s%s",
605                                         bp[0] & 0x04 ? "S" : "",
606                                         bp[0] & 0x02 ? "W" : "",
607                                         bp[0] & 0x01 ? "R" : "");
608                                 if (bp[0] & 0xf8) {
609                                         (void) printf("+0x%02x", bp[0] & 0xf8);
610                                 }
611                                 (void)printf(")");
612                         }
613                 }
614                 return hdrlen + 2 + len;
615         default:
616                 return -1;
617         }
618 trunc:
619         return -1;
620 }
621
622 static void
623 pimv2_print(register const u_char *bp, register u_int len, u_int cksum)
624 {
625         register const u_char *ep;
626         register struct pim *pim = (struct pim *)bp;
627         int advance;
628
629         ep = (const u_char *)snapend;
630         if (bp >= ep)
631                 return;
632         if (ep > bp + len)
633                 ep = bp + len;
634         TCHECK(pim->pim_rsv);
635         pimv2_addr_len = pim->pim_rsv;
636         if (pimv2_addr_len != 0)
637                 (void)printf(", RFC2117-encoding");
638
639         printf(", cksum 0x%04x ", EXTRACT_16BITS(&pim->pim_cksum));
640         if (EXTRACT_16BITS(&pim->pim_cksum) == 0) {
641                 printf("(unverified)");
642         } else {
643                 printf("(%scorrect)", TTEST2(bp[0], len) && cksum ? "in" : "" );
644         }
645
646         switch (PIM_TYPE(pim->pim_typever)) {
647         case PIMV2_TYPE_HELLO:
648             {
649                 u_int16_t otype, olen;
650                 bp += 4;
651                 while (bp < ep) {
652                         TCHECK2(bp[0], 4);
653                         otype = EXTRACT_16BITS(&bp[0]);
654                         olen = EXTRACT_16BITS(&bp[2]);
655                         TCHECK2(bp[0], 4 + olen);
656
657                         printf("\n\t  %s Option (%u), length %u, Value: ",
658                                tok2str( pimv2_hello_option_values,"Unknown",otype),
659                                otype,
660                                olen);
661                         bp += 4;
662
663                         switch (otype) {
664                         case PIMV2_HELLO_OPTION_HOLDTIME:
665                                 relts_print(EXTRACT_16BITS(bp));
666                                 break;
667
668                         case PIMV2_HELLO_OPTION_LANPRUNEDELAY:
669                                 if (olen != 4) {
670                                         (void)printf("ERROR: Option Length != 4 Bytes (%u)", olen);
671                                 } else {
672                                         char t_bit;
673                                         u_int16_t lan_delay, override_interval;
674                                         lan_delay = EXTRACT_16BITS(bp);
675                                         override_interval = EXTRACT_16BITS(bp+2);
676                                         t_bit = (lan_delay & 0x8000)? 1 : 0;
677                                         lan_delay &= ~0x8000;
678                                         (void)printf("\n\t    T-bit=%d, LAN delay %dms, Override interval %dms",
679                                         t_bit, lan_delay, override_interval);
680                                 }
681                                 break;
682
683                         case PIMV2_HELLO_OPTION_DR_PRIORITY_OLD:
684                         case PIMV2_HELLO_OPTION_DR_PRIORITY:
685                                 switch (olen) {
686                                 case 0:
687                                     printf("Bi-Directional Capability (Old)");
688                                     break;
689                                 case 4:
690                                     printf("%u", EXTRACT_32BITS(bp));
691                                     break;
692                                 default:
693                                     printf("ERROR: Option Length != 4 Bytes (%u)", olen);
694                                     break;
695                                 }
696                                 break;
697
698                         case PIMV2_HELLO_OPTION_GENID:
699                                 (void)printf("0x%08x", EXTRACT_32BITS(bp));
700                                 break;
701
702                         case PIMV2_HELLO_OPTION_REFRESH_CAP:
703                                 (void)printf("v%d", *bp);
704                                 if (*(bp+1) != 0) {
705                                     (void)printf(", interval ");
706                                     relts_print(*(bp+1));
707                                 }
708                                 if (EXTRACT_16BITS(bp+2) != 0) {
709                                     (void)printf(" ?0x%04x?", EXTRACT_16BITS(bp+2));
710                                 }
711                                 break;
712
713                         case  PIMV2_HELLO_OPTION_BIDIR_CAP:
714                                 break;
715
716                         case PIMV2_HELLO_OPTION_ADDRESS_LIST_OLD:
717                         case PIMV2_HELLO_OPTION_ADDRESS_LIST:
718                                 if (vflag > 1) {
719                                         const u_char *ptr = bp;
720                                         while (ptr < (bp+olen)) {
721                                                 int advance;
722
723                                                 printf("\n\t    ");
724                                                 advance = pimv2_addr_print(ptr, pimv2_unicast, 0);
725                                                 if (advance < 0) {
726                                                         printf("...");
727                                                         break;
728                                                 }
729                                                 ptr += advance;
730                                         }
731                                 }
732                                 break;
733                         default:
734                                 if (vflag <= 1)
735                                     print_unknown_data(bp,"\n\t    ",olen);
736                                 break;
737                         }
738                         /* do we want to see an additionally hexdump ? */
739                         if (vflag> 1)
740                             print_unknown_data(bp,"\n\t    ",olen);
741                         bp += olen;
742                 }
743                 break;
744             }
745
746         case PIMV2_TYPE_REGISTER:
747         {
748                 struct ip *ip;
749
750                 if (!TTEST2(*(bp+4), PIMV2_REGISTER_FLAG_LEN))
751                         goto trunc;
752
753                 printf(", Flags [ %s ]\n\t",
754                        tok2str(pimv2_register_flag_values,
755                                "none",
756                                EXTRACT_32BITS(bp+4)));
757
758                 bp += 8; len -= 8;
759                 /* encapsulated multicast packet */
760                 ip = (struct ip *)bp;
761                 switch (IP_V(ip)) {
762                 case 0: /* Null header */
763                         (void)printf("IP-Null-header %s > %s",
764                                      ipaddr_string(&ip->ip_src),
765                                      ipaddr_string(&ip->ip_dst));
766                         break;
767
768                 case 4: /* IPv4 */
769                         ip_print(gndo, bp, len);
770                         break;
771 #ifdef INET6
772                 case 6: /* IPv6 */
773                         ip6_print(gndo, bp, len);
774                         break;
775 #endif
776                 default:
777                         (void)printf("IP ver %d", IP_V(ip));
778                         break;
779                 }
780                 break;
781         }
782
783         case PIMV2_TYPE_REGISTER_STOP:
784                 bp += 4; len -= 4;
785                 if (bp >= ep)
786                         break;
787                 (void)printf(" group=");
788                 if ((advance = pimv2_addr_print(bp, pimv2_group, 0)) < 0) {
789                         (void)printf("...");
790                         break;
791                 }
792                 bp += advance; len -= advance;
793                 if (bp >= ep)
794                         break;
795                 (void)printf(" source=");
796                 if ((advance = pimv2_addr_print(bp, pimv2_unicast, 0)) < 0) {
797                         (void)printf("...");
798                         break;
799                 }
800                 bp += advance; len -= advance;
801                 break;
802
803         case PIMV2_TYPE_JOIN_PRUNE:
804         case PIMV2_TYPE_GRAFT:
805         case PIMV2_TYPE_GRAFT_ACK:
806
807
808         /*
809          * 0                   1                   2                   3
810          *   0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
811          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
812          *  |PIM Ver| Type  | Addr length   |           Checksum            |
813          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
814          *  |             Unicast-Upstream Neighbor Address                 |
815          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
816          *  |  Reserved     | Num groups    |          Holdtime             |
817          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
818          *  |            Encoded-Multicast Group Address-1                  |
819          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
820          *  |   Number of Joined  Sources   |   Number of Pruned Sources    |
821          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
822          *  |               Encoded-Joined Source Address-1                 |
823          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
824          *  |                             .                                 |
825          *  |                             .                                 |
826          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
827          *  |               Encoded-Joined Source Address-n                 |
828          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
829          *  |               Encoded-Pruned Source Address-1                 |
830          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
831          *  |                             .                                 |
832          *  |                             .                                 |
833          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
834          *  |               Encoded-Pruned Source Address-n                 |
835          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
836          *  |                           .                                   |
837          *  |                           .                                   |
838          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
839          *  |                Encoded-Multicast Group Address-n              |
840          *  +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
841          */
842
843             {
844                 u_int8_t ngroup;
845                 u_int16_t holdtime;
846                 u_int16_t njoin;
847                 u_int16_t nprune;
848                 int i, j;
849
850                 bp += 4; len -= 4;
851                 if (PIM_TYPE(pim->pim_typever) != 7) {  /*not for Graft-ACK*/
852                         if (bp >= ep)
853                                 break;
854                         (void)printf(", upstream-neighbor: ");
855                         if ((advance = pimv2_addr_print(bp, pimv2_unicast, 0)) < 0) {
856                                 (void)printf("...");
857                                 break;
858                         }
859                         bp += advance; len -= advance;
860                 }
861                 if (bp + 4 > ep)
862                         break;
863                 ngroup = bp[1];
864                 holdtime = EXTRACT_16BITS(&bp[2]);
865                 (void)printf("\n\t  %u group(s)", ngroup);
866                 if (PIM_TYPE(pim->pim_typever) != 7) {  /*not for Graft-ACK*/
867                         (void)printf(", holdtime: ");
868                         if (holdtime == 0xffff)
869                                 (void)printf("infinite");
870                         else
871                                 relts_print(holdtime);
872                 }
873                 bp += 4; len -= 4;
874                 for (i = 0; i < ngroup; i++) {
875                         if (bp >= ep)
876                                 goto jp_done;
877                         (void)printf("\n\t    group #%u: ", i+1);
878                         if ((advance = pimv2_addr_print(bp, pimv2_group, 0)) < 0) {
879                                 (void)printf("...)");
880                                 goto jp_done;
881                         }
882                         bp += advance; len -= advance;
883                         if (bp + 4 > ep) {
884                                 (void)printf("...)");
885                                 goto jp_done;
886                         }
887                         njoin = EXTRACT_16BITS(&bp[0]);
888                         nprune = EXTRACT_16BITS(&bp[2]);
889                         (void)printf(", joined sources: %u, pruned sources: %u", njoin,nprune);
890                         bp += 4; len -= 4;
891                         for (j = 0; j < njoin; j++) {
892                                 (void)printf("\n\t      joined source #%u: ",j+1);
893                                 if ((advance = pimv2_addr_print(bp, pimv2_source, 0)) < 0) {
894                                         (void)printf("...)");
895                                         goto jp_done;
896                                 }
897                                 bp += advance; len -= advance;
898                         }
899                         for (j = 0; j < nprune; j++) {
900                                 (void)printf("\n\t      pruned source #%u: ",j+1);
901                                 if ((advance = pimv2_addr_print(bp, pimv2_source, 0)) < 0) {
902                                         (void)printf("...)");
903                                         goto jp_done;
904                                 }
905                                 bp += advance; len -= advance;
906                         }
907                 }
908         jp_done:
909                 break;
910             }
911
912         case PIMV2_TYPE_BOOTSTRAP:
913         {
914                 int i, j, frpcnt;
915                 bp += 4;
916
917                 /* Fragment Tag, Hash Mask len, and BSR-priority */
918                 if (bp + sizeof(u_int16_t) >= ep) break;
919                 (void)printf(" tag=%x", EXTRACT_16BITS(bp));
920                 bp += sizeof(u_int16_t);
921                 if (bp >= ep) break;
922                 (void)printf(" hashmlen=%d", bp[0]);
923                 if (bp + 1 >= ep) break;
924                 (void)printf(" BSRprio=%d", bp[1]);
925                 bp += 2;
926
927                 /* Encoded-Unicast-BSR-Address */
928                 if (bp >= ep) break;
929                 (void)printf(" BSR=");
930                 if ((advance = pimv2_addr_print(bp, pimv2_unicast, 0)) < 0) {
931                         (void)printf("...");
932                         break;
933                 }
934                 bp += advance;
935
936                 for (i = 0; bp < ep; i++) {
937                         /* Encoded-Group Address */
938                         (void)printf(" (group%d: ", i);
939                         if ((advance = pimv2_addr_print(bp, pimv2_group, 0))
940                             < 0) {
941                                 (void)printf("...)");
942                                 goto bs_done;
943                         }
944                         bp += advance;
945
946                         /* RP-Count, Frag RP-Cnt, and rsvd */
947                         if (bp >= ep) {
948                                 (void)printf("...)");
949                                 goto bs_done;
950                         }
951                         (void)printf(" RPcnt=%d", bp[0]);
952                         if (bp + 1 >= ep) {
953                                 (void)printf("...)");
954                                 goto bs_done;
955                         }
956                         (void)printf(" FRPcnt=%d", frpcnt = bp[1]);
957                         bp += 4;
958
959                         for (j = 0; j < frpcnt && bp < ep; j++) {
960                                 /* each RP info */
961                                 (void)printf(" RP%d=", j);
962                                 if ((advance = pimv2_addr_print(bp,
963                                                                 pimv2_unicast,
964                                                                 0)) < 0) {
965                                         (void)printf("...)");
966                                         goto bs_done;
967                                 }
968                                 bp += advance;
969
970                                 if (bp + 1 >= ep) {
971                                         (void)printf("...)");
972                                         goto bs_done;
973                                 }
974                                 (void)printf(",holdtime=");
975                                 relts_print(EXTRACT_16BITS(bp));
976                                 if (bp + 2 >= ep) {
977                                         (void)printf("...)");
978                                         goto bs_done;
979                                 }
980                                 (void)printf(",prio=%d", bp[2]);
981                                 bp += 4;
982                         }
983                         (void)printf(")");
984                 }
985            bs_done:
986                 break;
987         }
988         case PIMV2_TYPE_ASSERT:
989                 bp += 4; len -= 4;
990                 if (bp >= ep)
991                         break;
992                 (void)printf(" group=");
993                 if ((advance = pimv2_addr_print(bp, pimv2_group, 0)) < 0) {
994                         (void)printf("...");
995                         break;
996                 }
997                 bp += advance; len -= advance;
998                 if (bp >= ep)
999                         break;
1000                 (void)printf(" src=");
1001                 if ((advance = pimv2_addr_print(bp, pimv2_unicast, 0)) < 0) {
1002                         (void)printf("...");
1003                         break;
1004                 }
1005                 bp += advance; len -= advance;
1006                 if (bp + 8 > ep)
1007                         break;
1008                 if (bp[0] & 0x80)
1009                         (void)printf(" RPT");
1010                 (void)printf(" pref=%u", EXTRACT_32BITS(&bp[0]) & 0x7fffffff);
1011                 (void)printf(" metric=%u", EXTRACT_32BITS(&bp[4]));
1012                 break;
1013
1014         case PIMV2_TYPE_CANDIDATE_RP:
1015         {
1016                 int i, pfxcnt;
1017                 bp += 4;
1018
1019                 /* Prefix-Cnt, Priority, and Holdtime */
1020                 if (bp >= ep) break;
1021                 (void)printf(" prefix-cnt=%d", bp[0]);
1022                 pfxcnt = bp[0];
1023                 if (bp + 1 >= ep) break;
1024                 (void)printf(" prio=%d", bp[1]);
1025                 if (bp + 3 >= ep) break;
1026                 (void)printf(" holdtime=");
1027                 relts_print(EXTRACT_16BITS(&bp[2]));
1028                 bp += 4;
1029
1030                 /* Encoded-Unicast-RP-Address */
1031                 if (bp >= ep) break;
1032                 (void)printf(" RP=");
1033                 if ((advance = pimv2_addr_print(bp, pimv2_unicast, 0)) < 0) {
1034                         (void)printf("...");
1035                         break;
1036                 }
1037                 bp += advance;
1038
1039                 /* Encoded-Group Addresses */
1040                 for (i = 0; i < pfxcnt && bp < ep; i++) {
1041                         (void)printf(" Group%d=", i);
1042                         if ((advance = pimv2_addr_print(bp, pimv2_group, 0))
1043                             < 0) {
1044                                 (void)printf("...");
1045                                 break;
1046                         }
1047                         bp += advance;
1048                 }
1049                 break;
1050         }
1051
1052         case PIMV2_TYPE_PRUNE_REFRESH:
1053                 (void)printf(" src=");
1054                 if ((advance = pimv2_addr_print(bp, pimv2_unicast, 0)) < 0) {
1055                         (void)printf("...");
1056                         break;
1057                 }
1058                 bp += advance;
1059                 (void)printf(" grp=");
1060                 if ((advance = pimv2_addr_print(bp, pimv2_group, 0)) < 0) {
1061                         (void)printf("...");
1062                         break;
1063                 }
1064                 bp += advance;
1065                 (void)printf(" forwarder=");
1066                 if ((advance = pimv2_addr_print(bp, pimv2_unicast, 0)) < 0) {
1067                         (void)printf("...");
1068                         break;
1069                 }
1070                 bp += advance;
1071                 TCHECK2(bp[0], 2);
1072                 (void)printf(" TUNR ");
1073                 relts_print(EXTRACT_16BITS(bp));
1074                 break;
1075
1076
1077          default:
1078                 (void)printf(" [type %d]", PIM_TYPE(pim->pim_typever));
1079                 break;
1080         }
1081
1082         return;
1083
1084 trunc:
1085         (void)printf("[|pim]");
1086 }
1087
1088 /*
1089  * Local Variables:
1090  * c-style: whitesmith
1091  * c-basic-offset: 8
1092  * End:
1093  */