X-Git-Url: https://git.tcpdump.org/tcpdump/blobdiff_plain/55ea995e73e351eaf7a480a7b74b3bd75a3f5556..1fb50928ce27360c1c987312774f686b23c69b51:/print-pgm.c diff --git a/print-pgm.c b/print-pgm.c index d7a40cb8..6d5c01ce 100644 --- a/print-pgm.c +++ b/print-pgm.c @@ -13,83 +13,84 @@ * Original code by Andy Heffernan (ahh@juniper.net) */ -#ifndef lint -static const char rcsid[] _U_ = - "@(#) $Header: /tcpdump/master/tcpdump/print-pgm.c,v 1.2 2005-05-23 21:38:06 guy Exp $"; -#endif +/* \summary: Pragmatic General Multicast (PGM) printer */ #ifdef HAVE_CONFIG_H #include "config.h" #endif -#include - -#include -#include -#include +#include -#include "interface.h" +#include "netdissect.h" #include "extract.h" #include "addrtoname.h" +#include "addrtostr.h" #include "ip.h" #include "ip6.h" #include "ipproto.h" +#include "af.h" /* * PGM header (RFC 3208) */ struct pgm_header { - u_int16_t pgm_sport; - u_int16_t pgm_dport; - u_int8_t pgm_type; - u_int8_t pgm_options; - u_int16_t pgm_sum; - u_int8_t pgm_gsid[6]; - u_int16_t pgm_length; + uint16_t pgm_sport; + uint16_t pgm_dport; + uint8_t pgm_type; + uint8_t pgm_options; + uint16_t pgm_sum; + uint8_t pgm_gsid[6]; + uint16_t pgm_length; }; struct pgm_spm { - u_int32_t pgms_seq; - u_int32_t pgms_trailseq; - u_int32_t pgms_leadseq; - u_int16_t pgms_nla_afi; - u_int16_t pgms_reserved; - u_int8_t pgms_nla[0]; + uint32_t pgms_seq; + uint32_t pgms_trailseq; + uint32_t pgms_leadseq; + uint16_t pgms_nla_afi; + uint16_t pgms_reserved; + /* ... uint8_t pgms_nla[0]; */ /* ... options */ }; struct pgm_nak { - u_int32_t pgmn_seq; - u_int16_t pgmn_source_afi; - u_int16_t pgmn_reserved; - u_int8_t pgmn_source[0]; - /* ... u_int16_t pgmn_group_afi */ - /* ... u_int16_t pgmn_reserved2; */ - /* ... u_int8_t pgmn_group[0]; */ + uint32_t pgmn_seq; + uint16_t pgmn_source_afi; + uint16_t pgmn_reserved; + /* ... uint8_t pgmn_source[0]; */ + /* ... uint16_t pgmn_group_afi */ + /* ... uint16_t pgmn_reserved2; */ + /* ... uint8_t pgmn_group[0]; */ + /* ... options */ +}; + +struct pgm_ack { + uint32_t pgma_rx_max_seq; + uint32_t pgma_bitmap; /* ... options */ }; struct pgm_poll { - u_int32_t pgmp_seq; - u_int16_t pgmp_round; - u_int16_t pgmp_reserved; + uint32_t pgmp_seq; + uint16_t pgmp_round; + uint16_t pgmp_reserved; /* ... options */ }; struct pgm_polr { - u_int32_t pgmp_seq; - u_int16_t pgmp_round; - u_int16_t pgmp_subtype; - u_int16_t pgmp_nla_afi; - u_int16_t pgmp_reserved; - u_int8_t pgmp_nla[0]; + uint32_t pgmp_seq; + uint16_t pgmp_round; + uint16_t pgmp_subtype; + uint16_t pgmp_nla_afi; + uint16_t pgmp_reserved; + /* ... uint8_t pgmp_nla[0]; */ /* ... options */ }; struct pgm_data { - u_int32_t pgmd_seq; - u_int32_t pgmd_trailseq; + uint32_t pgmd_seq; + uint32_t pgmd_trailseq; /* ... options */ }; @@ -131,58 +132,48 @@ typedef enum _pgm_type { #define PGM_OPT_RST 0x0F #define PGM_OPT_CR 0x10 #define PGM_OPT_CRQST 0x11 - + +#define PGM_OPT_PGMCC_DATA 0x12 +#define PGM_OPT_PGMCC_FEEDBACK 0x13 + #define PGM_OPT_MASK 0x7f #define PGM_OPT_END 0x80 /* end of options marker */ #define PGM_MIN_OPT_LEN 4 -#ifndef AFI_IP -#define AFI_IP 1 -#define AFI_IP6 2 -#endif - void -pgm_print(register const u_char *bp, register u_int length, - register const u_char *bp2) +pgm_print(netdissect_options *ndo, + register const u_char *bp, register u_int length, + register const u_char *bp2) { register const struct pgm_header *pgm; register const struct ip *ip; register char ch; - u_int16_t sport, dport; - int addr_size; - const void *nla; - int nla_af; + uint16_t sport, dport; + u_int nla_afnum; char nla_buf[INET6_ADDRSTRLEN]; -#ifdef INET6 register const struct ip6_hdr *ip6; -#endif - u_int8_t opt_type, opt_len, flags1, flags2; - u_int32_t seq, opts_len, len, offset; + uint8_t opt_type, opt_len; + uint32_t seq, opts_len, len, offset; - pgm = (struct pgm_header *)bp; - ip = (struct ip *)bp2; -#ifdef INET6 + pgm = (const struct pgm_header *)bp; + ip = (const struct ip *)bp2; if (IP_V(ip) == 6) - ip6 = (struct ip6_hdr *)bp2; + ip6 = (const struct ip6_hdr *)bp2; else ip6 = NULL; -#endif /*INET6*/ ch = '\0'; - if (!TTEST(pgm->pgm_dport)) { -#ifdef INET6 + if (!ND_TTEST(pgm->pgm_dport)) { if (ip6) { - (void)printf("%s > %s: [|pgm]", - ip6addr_string(&ip6->ip6_src), - ip6addr_string(&ip6->ip6_dst)); + ND_PRINT((ndo, "%s > %s: [|pgm]", + ip6addr_string(ndo, &ip6->ip6_src), + ip6addr_string(ndo, &ip6->ip6_dst))); return; - } else -#endif /* INET6 */ - { - (void)printf("%s > %s: [|pgm]", - ipaddr_string(&ip->ip_src), - ipaddr_string(&ip->ip_dst)); + } else { + ND_PRINT((ndo, "%s > %s: [|pgm]", + ipaddr_string(ndo, &ip->ip_src), + ipaddr_string(ndo, &ip->ip_dst))); return; } } @@ -190,254 +181,253 @@ pgm_print(register const u_char *bp, register u_int length, sport = EXTRACT_16BITS(&pgm->pgm_sport); dport = EXTRACT_16BITS(&pgm->pgm_dport); -#ifdef INET6 if (ip6) { if (ip6->ip6_nxt == IPPROTO_PGM) { - (void)printf("%s.%s > %s.%s: ", - ip6addr_string(&ip6->ip6_src), - tcpport_string(sport), - ip6addr_string(&ip6->ip6_dst), - tcpport_string(dport)); + ND_PRINT((ndo, "%s.%s > %s.%s: ", + ip6addr_string(ndo, &ip6->ip6_src), + tcpport_string(ndo, sport), + ip6addr_string(ndo, &ip6->ip6_dst), + tcpport_string(ndo, dport))); } else { - (void)printf("%s > %s: ", - tcpport_string(sport), tcpport_string(dport)); + ND_PRINT((ndo, "%s > %s: ", + tcpport_string(ndo, sport), tcpport_string(ndo, dport))); } - } else -#endif /*INET6*/ - { + } else { if (ip->ip_p == IPPROTO_PGM) { - (void)printf("%s.%s > %s.%s: ", - ipaddr_string(&ip->ip_src), - tcpport_string(sport), - ipaddr_string(&ip->ip_dst), - tcpport_string(dport)); + ND_PRINT((ndo, "%s.%s > %s.%s: ", + ipaddr_string(ndo, &ip->ip_src), + tcpport_string(ndo, sport), + ipaddr_string(ndo, &ip->ip_dst), + tcpport_string(ndo, dport))); } else { - (void)printf("%s > %s: ", - tcpport_string(sport), tcpport_string(dport)); + ND_PRINT((ndo, "%s > %s: ", + tcpport_string(ndo, sport), tcpport_string(ndo, dport))); } } - TCHECK(*pgm); + ND_TCHECK(*pgm); - (void)printf("PGM, length %u", pgm->pgm_length); + ND_PRINT((ndo, "PGM, length %u", EXTRACT_16BITS(&pgm->pgm_length))); - if (!vflag) + if (!ndo->ndo_vflag) return; - if (length > pgm->pgm_length) - length = pgm->pgm_length; - - (void)printf(" 0x%02x%02x%02x%02x%02x%02x ", + ND_PRINT((ndo, " 0x%02x%02x%02x%02x%02x%02x ", pgm->pgm_gsid[0], pgm->pgm_gsid[1], pgm->pgm_gsid[2], pgm->pgm_gsid[3], pgm->pgm_gsid[4], - pgm->pgm_gsid[5]); + pgm->pgm_gsid[5])); switch (pgm->pgm_type) { case PGM_SPM: { - struct pgm_spm *spm; + const struct pgm_spm *spm; - spm = (struct pgm_spm *)(pgm + 1); - TCHECK(*spm); + spm = (const struct pgm_spm *)(pgm + 1); + ND_TCHECK(*spm); + bp = (const u_char *) (spm + 1); switch (EXTRACT_16BITS(&spm->pgms_nla_afi)) { - case AFI_IP: - addr_size = sizeof(struct in_addr); - nla_af = AF_INET; + case AFNUM_INET: + ND_TCHECK2(*bp, sizeof(struct in_addr)); + addrtostr(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in_addr); break; - case AFI_IP6: - addr_size = sizeof(struct in6_addr); - nla_af = AF_INET6; + case AFNUM_INET6: + ND_TCHECK2(*bp, sizeof(struct in6_addr)); + addrtostr6(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in6_addr); break; default: goto trunc; break; } - bp = (u_char *) (spm + 1); - TCHECK2(*bp, addr_size); - nla = bp; - bp += addr_size; - inet_ntop(nla_af, nla, nla_buf, sizeof(nla_buf)); - (void)printf("SPM seq %u trail %u lead %u nla %s", + ND_PRINT((ndo, "SPM seq %u trail %u lead %u nla %s", EXTRACT_32BITS(&spm->pgms_seq), EXTRACT_32BITS(&spm->pgms_trailseq), EXTRACT_32BITS(&spm->pgms_leadseq), - nla_buf); + nla_buf)); break; } case PGM_POLL: { - struct pgm_poll *poll; - - poll = (struct pgm_poll *)(pgm + 1); - TCHECK(*poll); - (void)printf("POLL seq %u round %u", - EXTRACT_32BITS(&poll->pgmp_seq), - EXTRACT_16BITS(&poll->pgmp_round)); + const struct pgm_poll *poll_msg; + + poll_msg = (const struct pgm_poll *)(pgm + 1); + ND_TCHECK(*poll_msg); + ND_PRINT((ndo, "POLL seq %u round %u", + EXTRACT_32BITS(&poll_msg->pgmp_seq), + EXTRACT_16BITS(&poll_msg->pgmp_round))); + bp = (const u_char *) (poll_msg + 1); break; } case PGM_POLR: { - struct pgm_polr *polr; - u_int32_t ivl, rnd, mask; + const struct pgm_polr *polr; + uint32_t ivl, rnd, mask; - polr = (struct pgm_polr *)(pgm + 1); - TCHECK(*polr); + polr = (const struct pgm_polr *)(pgm + 1); + ND_TCHECK(*polr); + bp = (const u_char *) (polr + 1); switch (EXTRACT_16BITS(&polr->pgmp_nla_afi)) { - case AFI_IP: - addr_size = sizeof(struct in_addr); - nla_af = AF_INET; + case AFNUM_INET: + ND_TCHECK2(*bp, sizeof(struct in_addr)); + addrtostr(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in_addr); break; - case AFI_IP6: - addr_size = sizeof(struct in6_addr); - nla_af = AF_INET6; + case AFNUM_INET6: + ND_TCHECK2(*bp, sizeof(struct in6_addr)); + addrtostr6(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in6_addr); break; default: goto trunc; break; } - bp = (u_char *) (polr + 1); - TCHECK2(*bp, addr_size); - nla = bp; - bp += addr_size; - - inet_ntop(nla_af, nla, nla_buf, sizeof(nla_buf)); - TCHECK2(*bp, sizeof(u_int32_t)); - ivl = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); + ND_TCHECK2(*bp, sizeof(uint32_t)); + ivl = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); - TCHECK2(*bp, sizeof(u_int32_t)); - rnd = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); + ND_TCHECK2(*bp, sizeof(uint32_t)); + rnd = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); - TCHECK2(*bp, sizeof(u_int32_t)); - mask = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); + ND_TCHECK2(*bp, sizeof(uint32_t)); + mask = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); - (void)printf("POLR seq %u round %u nla %s ivl %u rnd 0x%08x " - "mask 0x%08x", EXTRACT_32BITS(polr->pgmp_seq), - EXTRACT_16BITS(&polr->pgmp_round), nla_buf, ivl, rnd, mask); + ND_PRINT((ndo, "POLR seq %u round %u nla %s ivl %u rnd 0x%08x " + "mask 0x%08x", EXTRACT_32BITS(&polr->pgmp_seq), + EXTRACT_16BITS(&polr->pgmp_round), nla_buf, ivl, rnd, mask)); break; } case PGM_ODATA: { - struct pgm_data *odata; - - odata = (struct pgm_data *)(pgm + 1); - TCHECK(*odata); - (void)printf("ODATA trail %u seq %u", - EXTRACT_32BITS(odata->pgmd_trailseq), EXTRACT_32BITS(odata->pgmd_seq)); + const struct pgm_data *odata; + + odata = (const struct pgm_data *)(pgm + 1); + ND_TCHECK(*odata); + ND_PRINT((ndo, "ODATA trail %u seq %u", + EXTRACT_32BITS(&odata->pgmd_trailseq), + EXTRACT_32BITS(&odata->pgmd_seq))); + bp = (const u_char *) (odata + 1); break; } case PGM_RDATA: { - struct pgm_data *rdata; - - rdata = (struct pgm_data *)(pgm + 1); - TCHECK(*rdata); - (void)printf("RDATA trail %u seq %u", - EXTRACT_32BITS(rdata->pgmd_trailseq), EXTRACT_32BITS(rdata->pgmd_seq)); + const struct pgm_data *rdata; + + rdata = (const struct pgm_data *)(pgm + 1); + ND_TCHECK(*rdata); + ND_PRINT((ndo, "RDATA trail %u seq %u", + EXTRACT_32BITS(&rdata->pgmd_trailseq), + EXTRACT_32BITS(&rdata->pgmd_seq))); + bp = (const u_char *) (rdata + 1); break; } case PGM_NAK: case PGM_NULLNAK: case PGM_NCF: { - struct pgm_nak *nak; - const void *source, *group; - int source_af, group_af; + const struct pgm_nak *nak; char source_buf[INET6_ADDRSTRLEN], group_buf[INET6_ADDRSTRLEN]; - nak = (struct pgm_nak *)(pgm + 1); - TCHECK(*nak); + nak = (const struct pgm_nak *)(pgm + 1); + ND_TCHECK(*nak); + bp = (const u_char *) (nak + 1); /* * Skip past the source, saving info along the way * and stopping if we don't have enough. */ switch (EXTRACT_16BITS(&nak->pgmn_source_afi)) { - case AFI_IP: - addr_size = sizeof(struct in_addr); - source_af = AF_INET; + case AFNUM_INET: + ND_TCHECK2(*bp, sizeof(struct in_addr)); + addrtostr(bp, source_buf, sizeof(source_buf)); + bp += sizeof(struct in_addr); break; - case AFI_IP6: - addr_size = sizeof(struct in6_addr); - source_af = AF_INET6; + case AFNUM_INET6: + ND_TCHECK2(*bp, sizeof(struct in6_addr)); + addrtostr6(bp, source_buf, sizeof(source_buf)); + bp += sizeof(struct in6_addr); break; default: goto trunc; break; } - bp = (u_char *) (nak + 1); - TCHECK2(*bp, addr_size); - source = bp; - bp += addr_size; /* * Skip past the group, saving info along the way * and stopping if we don't have enough. */ + bp += (2 * sizeof(uint16_t)); switch (EXTRACT_16BITS(bp)) { - case AFI_IP: - addr_size = sizeof(struct in_addr); - group_af = AF_INET; + case AFNUM_INET: + ND_TCHECK2(*bp, sizeof(struct in_addr)); + addrtostr(bp, group_buf, sizeof(group_buf)); + bp += sizeof(struct in_addr); break; - case AFI_IP6: - addr_size = sizeof(struct in6_addr); - group_af = AF_INET6; + case AFNUM_INET6: + ND_TCHECK2(*bp, sizeof(struct in6_addr)); + addrtostr6(bp, group_buf, sizeof(group_buf)); + bp += sizeof(struct in6_addr); break; default: goto trunc; break; } - bp += (2 * sizeof(u_int16_t)); - TCHECK2(*bp, addr_size); - group = bp; - bp += addr_size; /* * Options decoding can go here. */ - inet_ntop(source_af, source, source_buf, sizeof(source_buf)); - inet_ntop(group_af, group, group_buf, sizeof(group_buf)); switch (pgm->pgm_type) { case PGM_NAK: - (void)printf("NAK "); + ND_PRINT((ndo, "NAK ")); break; case PGM_NULLNAK: - (void)printf("NNAK "); + ND_PRINT((ndo, "NNAK ")); break; case PGM_NCF: - (void)printf("NCF "); + ND_PRINT((ndo, "NCF ")); break; default: break; } - (void)printf("(%s -> %s), seq %u", - source_buf, group_buf, EXTRACT_32BITS(nak->pgmn_seq)); + ND_PRINT((ndo, "(%s -> %s), seq %u", + source_buf, group_buf, EXTRACT_32BITS(&nak->pgmn_seq))); + break; + } + + case PGM_ACK: { + const struct pgm_ack *ack; + + ack = (const struct pgm_ack *)(pgm + 1); + ND_TCHECK(*ack); + ND_PRINT((ndo, "ACK seq %u", + EXTRACT_32BITS(&ack->pgma_rx_max_seq))); + bp = (const u_char *) (ack + 1); break; } case PGM_SPMR: - (void)printf("SPMR"); + ND_PRINT((ndo, "SPMR")); break; default: - (void)printf("UNKNOWN type %0x02x", pgm->pgm_type); + ND_PRINT((ndo, "UNKNOWN type 0x%02x", pgm->pgm_type)); break; } - if (pgm->pgm_options & PGM_OPT_BIT_PRESENT) { + if (pgm->pgm_options & PGM_OPT_BIT_PRESENT) { /* * make sure there's enough for the first option header */ - if (!TTEST2(*bp, PGM_MIN_OPT_LEN)) { - (void)printf("[|OPT]"); + if (!ND_TTEST2(*bp, PGM_MIN_OPT_LEN)) { + ND_PRINT((ndo, "[|OPT]")); return; - } + } /* * That option header MUST be an OPT_LENGTH option @@ -445,271 +435,331 @@ pgm_print(register const u_char *bp, register u_int length, */ opt_type = *bp++; if ((opt_type & PGM_OPT_MASK) != PGM_OPT_LENGTH) { - (void)printf("[First option bad, should be PGM_OPT_LENGTH, is %u]", opt_type); + ND_PRINT((ndo, "[First option bad, should be PGM_OPT_LENGTH, is %u]", opt_type & PGM_OPT_MASK)); return; } opt_len = *bp++; if (opt_len != 4) { - (void)printf("[Bad OPT_LENGTH option, length %u != 4]", opt_len); + ND_PRINT((ndo, "[Bad OPT_LENGTH option, length %u != 4]", opt_len)); return; } opts_len = EXTRACT_16BITS(bp); if (opts_len < 4) { - (void)printf("[Bad total option length %u < 4]", opts_len); + ND_PRINT((ndo, "[Bad total option length %u < 4]", opts_len)); return; } - bp += sizeof(u_int16_t); - (void)printf(" OPTS LEN %d", opts_len); + bp += sizeof(uint16_t); + ND_PRINT((ndo, " OPTS LEN %d", opts_len)); opts_len -= 4; while (opts_len) { if (opts_len < PGM_MIN_OPT_LEN) { - (void)printf("[Total option length leaves no room for final option]"); + ND_PRINT((ndo, "[Total option length leaves no room for final option]")); return; } opt_type = *bp++; opt_len = *bp++; if (opt_len < PGM_MIN_OPT_LEN) { - (void)printf("[Bad option, length %u < %u]", opt_len, - PGM_MIN_OPT_LEN); + ND_PRINT((ndo, "[Bad option, length %u < %u]", opt_len, + PGM_MIN_OPT_LEN)); break; } if (opts_len < opt_len) { - (void)printf("[Total option length leaves no room for final option]"); + ND_PRINT((ndo, "[Total option length leaves no room for final option]")); return; } - if (!TTEST2(*bp, opt_len - 2)) { - (void)printf(" [|OPT]"); + if (!ND_TTEST2(*bp, opt_len - 2)) { + ND_PRINT((ndo, " [|OPT]")); return; - } + } switch (opt_type & PGM_OPT_MASK) { case PGM_OPT_LENGTH: if (opt_len != 4) { - (void)printf("[Bad OPT_LENGTH option, length %u != 4]", opt_len); + ND_PRINT((ndo, "[Bad OPT_LENGTH option, length %u != 4]", opt_len)); return; } - (void)printf(" OPTS LEN (extra?) %d", EXTRACT_16BITS(bp)); - bp += sizeof(u_int16_t); + ND_PRINT((ndo, " OPTS LEN (extra?) %d", EXTRACT_16BITS(bp))); + bp += sizeof(uint16_t); opts_len -= 4; break; case PGM_OPT_FRAGMENT: - if (opt_len != 12) { - (void)printf("[Bad OPT_FRAGMENT option, length %u != 12]", opt_len); + if (opt_len != 16) { + ND_PRINT((ndo, "[Bad OPT_FRAGMENT option, length %u != 16]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - seq = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - offset = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - len = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - (void)printf(" FRAG seq %u off %u len %u", seq, offset, len); - opts_len -= 12; + bp += 2; + seq = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + offset = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + len = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + ND_PRINT((ndo, " FRAG seq %u off %u len %u", seq, offset, len)); + opts_len -= 16; break; case PGM_OPT_NAK_LIST: - flags1 = *bp++; - flags2 = *bp++; - opt_len -= sizeof(u_int32_t); /* option header */ - (void)printf(" NAK LIST"); + bp += 2; + opt_len -= sizeof(uint32_t); /* option header */ + ND_PRINT((ndo, " NAK LIST")); while (opt_len) { - if (opt_len < sizeof(u_int32_t)) { - (void)printf("[Option length not a multiple of 4]"); + if (opt_len < sizeof(uint32_t)) { + ND_PRINT((ndo, "[Option length not a multiple of 4]")); return; } - TCHECK2(*bp, sizeof(u_int32_t)); - (void)printf(" %u", EXTRACT_32BITS(*(u_int32_t *)bp)); - bp += sizeof(u_int32_t); - opt_len -= sizeof(u_int32_t); - opts_len -= sizeof(u_int32_t); + ND_TCHECK2(*bp, sizeof(uint32_t)); + ND_PRINT((ndo, " %u", EXTRACT_32BITS(bp))); + bp += sizeof(uint32_t); + opt_len -= sizeof(uint32_t); + opts_len -= sizeof(uint32_t); } break; case PGM_OPT_JOIN: if (opt_len != 8) { - (void)printf("[Bad OPT_JOIN option, length %u != 8]", opt_len); + ND_PRINT((ndo, "[Bad OPT_JOIN option, length %u != 8]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - seq = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - (void)printf(" JOIN %u", seq); + bp += 2; + seq = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + ND_PRINT((ndo, " JOIN %u", seq)); opts_len -= 8; break; case PGM_OPT_NAK_BO_IVL: if (opt_len != 12) { - (void)printf("[Bad OPT_FRAGMENT option, length %u != 12]", opt_len); + ND_PRINT((ndo, "[Bad OPT_NAK_BO_IVL option, length %u != 12]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - offset = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - seq = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - (void)printf(" BACKOFF ivl %u ivlseq %u", offset, seq); + bp += 2; + offset = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + seq = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + ND_PRINT((ndo, " BACKOFF ivl %u ivlseq %u", offset, seq)); opts_len -= 12; break; case PGM_OPT_NAK_BO_RNG: if (opt_len != 12) { - (void)printf("[Bad OPT_FRAGMENT option, length %u != 12]", opt_len); + ND_PRINT((ndo, "[Bad OPT_NAK_BO_RNG option, length %u != 12]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - offset = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - seq = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - (void)printf(" BACKOFF max %u min %u", offset, seq); + bp += 2; + offset = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + seq = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + ND_PRINT((ndo, " BACKOFF max %u min %u", offset, seq)); opts_len -= 12; break; case PGM_OPT_REDIRECT: - flags1 = *bp++; - flags2 = *bp++; - switch (EXTRACT_16BITS(bp)) { - case AFI_IP: - addr_size = sizeof(struct in_addr); - nla_af = AF_INET; + bp += 2; + nla_afnum = EXTRACT_16BITS(bp); + bp += (2 * sizeof(uint16_t)); + switch (nla_afnum) { + case AFNUM_INET: + if (opt_len != 4 + sizeof(struct in_addr)) { + ND_PRINT((ndo, "[Bad OPT_REDIRECT option, length %u != 4 + address size]", opt_len)); + return; + } + ND_TCHECK2(*bp, sizeof(struct in_addr)); + addrtostr(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in_addr); + opts_len -= 4 + sizeof(struct in_addr); break; - case AFI_IP6: - addr_size = sizeof(struct in6_addr); - nla_af = AF_INET6; + case AFNUM_INET6: + if (opt_len != 4 + sizeof(struct in6_addr)) { + ND_PRINT((ndo, "[Bad OPT_REDIRECT option, length %u != 4 + address size]", opt_len)); + return; + } + ND_TCHECK2(*bp, sizeof(struct in6_addr)); + addrtostr6(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in6_addr); + opts_len -= 4 + sizeof(struct in6_addr); break; default: goto trunc; break; } - bp += (2 * sizeof(u_int16_t)); - if (opt_len != 4 + addr_size) { - (void)printf("[Bad OPT_REDIRECT option, length %u != 4 + address size]", opt_len); - return; - } - TCHECK2(*bp, addr_size); - nla = bp; - bp += addr_size; - inet_ntop(nla_af, nla, nla_buf, sizeof(nla_buf)); - (void)printf(" REDIRECT %s", (char *)nla); - opts_len -= 4 + addr_size; + ND_PRINT((ndo, " REDIRECT %s", nla_buf)); break; case PGM_OPT_PARITY_PRM: if (opt_len != 8) { - (void)printf("[Bad OPT_PARITY_PRM option, length %u != 8]", opt_len); + ND_PRINT((ndo, "[Bad OPT_PARITY_PRM option, length %u != 8]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - len = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - (void)printf(" PARITY MAXTGS %u", len); + bp += 2; + len = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + ND_PRINT((ndo, " PARITY MAXTGS %u", len)); opts_len -= 8; break; case PGM_OPT_PARITY_GRP: if (opt_len != 8) { - (void)printf("[Bad OPT_PARITY_GRP option, length %u != 8]", opt_len); + ND_PRINT((ndo, "[Bad OPT_PARITY_GRP option, length %u != 8]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - seq = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - (void)printf(" PARITY GROUP %u", seq); + bp += 2; + seq = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + ND_PRINT((ndo, " PARITY GROUP %u", seq)); opts_len -= 8; break; case PGM_OPT_CURR_TGSIZE: if (opt_len != 8) { - (void)printf("[Bad OPT_PARITY_GRP option, length %u != 8]", opt_len); + ND_PRINT((ndo, "[Bad OPT_CURR_TGSIZE option, length %u != 8]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - len = EXTRACT_32BITS(*(u_int32_t *)bp); - bp += sizeof(u_int32_t); - (void)printf(" PARITY ATGS %u", len); + bp += 2; + len = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + ND_PRINT((ndo, " PARITY ATGS %u", len)); opts_len -= 8; break; case PGM_OPT_NBR_UNREACH: if (opt_len != 4) { - (void)printf("[Bad OPT_NBR_UNREACH option, length %u != 4]", opt_len); + ND_PRINT((ndo, "[Bad OPT_NBR_UNREACH option, length %u != 4]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - (void)printf(" NBR_UNREACH"); + bp += 2; + ND_PRINT((ndo, " NBR_UNREACH")); opts_len -= 4; break; case PGM_OPT_PATH_NLA: - (void)printf(" PATH_NLA [%d]", opt_len); + ND_PRINT((ndo, " PATH_NLA [%d]", opt_len)); bp += opt_len; opts_len -= opt_len; break; case PGM_OPT_SYN: if (opt_len != 4) { - (void)printf("[Bad OPT_SYN option, length %u != 4]", opt_len); + ND_PRINT((ndo, "[Bad OPT_SYN option, length %u != 4]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - (void)printf(" SYN"); + bp += 2; + ND_PRINT((ndo, " SYN")); opts_len -= 4; break; case PGM_OPT_FIN: if (opt_len != 4) { - (void)printf("[Bad OPT_RST option, length %u != 4]", opt_len); + ND_PRINT((ndo, "[Bad OPT_FIN option, length %u != 4]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - (void)printf(" FIN"); + bp += 2; + ND_PRINT((ndo, " FIN")); opts_len -= 4; break; case PGM_OPT_RST: if (opt_len != 4) { - (void)printf("[Bad OPT_RST option, length %u != 4]", opt_len); + ND_PRINT((ndo, "[Bad OPT_RST option, length %u != 4]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - (void)printf(" RST"); + bp += 2; + ND_PRINT((ndo, " RST")); opts_len -= 4; break; case PGM_OPT_CR: - (void)printf(" CR"); + ND_PRINT((ndo, " CR")); bp += opt_len; opts_len -= opt_len; break; case PGM_OPT_CRQST: if (opt_len != 4) { - (void)printf("[Bad OPT_CRQST option, length %u != 4]", opt_len); + ND_PRINT((ndo, "[Bad OPT_CRQST option, length %u != 4]", opt_len)); return; } - flags1 = *bp++; - flags2 = *bp++; - (void)printf(" CRQST"); + bp += 2; + ND_PRINT((ndo, " CRQST")); opts_len -= 4; break; + case PGM_OPT_PGMCC_DATA: + bp += 2; + offset = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + nla_afnum = EXTRACT_16BITS(bp); + bp += (2 * sizeof(uint16_t)); + switch (nla_afnum) { + case AFNUM_INET: + if (opt_len != 12 + sizeof(struct in_addr)) { + ND_PRINT((ndo, "[Bad OPT_PGMCC_DATA option, length %u != 12 + address size]", opt_len)); + return; + } + ND_TCHECK2(*bp, sizeof(struct in_addr)); + addrtostr(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in_addr); + opts_len -= 12 + sizeof(struct in_addr); + break; + case AFNUM_INET6: + if (opt_len != 12 + sizeof(struct in6_addr)) { + ND_PRINT((ndo, "[Bad OPT_PGMCC_DATA option, length %u != 12 + address size]", opt_len)); + return; + } + ND_TCHECK2(*bp, sizeof(struct in6_addr)); + addrtostr6(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in6_addr); + opts_len -= 12 + sizeof(struct in6_addr); + break; + default: + goto trunc; + break; + } + + ND_PRINT((ndo, " PGMCC DATA %u %s", offset, nla_buf)); + break; + + case PGM_OPT_PGMCC_FEEDBACK: + bp += 2; + offset = EXTRACT_32BITS(bp); + bp += sizeof(uint32_t); + nla_afnum = EXTRACT_16BITS(bp); + bp += (2 * sizeof(uint16_t)); + switch (nla_afnum) { + case AFNUM_INET: + if (opt_len != 12 + sizeof(struct in_addr)) { + ND_PRINT((ndo, "[Bad OPT_PGMCC_DATA option, length %u != 12 + address size]", opt_len)); + return; + } + ND_TCHECK2(*bp, sizeof(struct in_addr)); + addrtostr(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in_addr); + opts_len -= 12 + sizeof(struct in_addr); + break; + case AFNUM_INET6: + if (opt_len != 12 + sizeof(struct in6_addr)) { + ND_PRINT((ndo, "[Bad OPT_PGMCC_DATA option, length %u != 12 + address size]", opt_len)); + return; + } + ND_TCHECK2(*bp, sizeof(struct in6_addr)); + addrtostr6(bp, nla_buf, sizeof(nla_buf)); + bp += sizeof(struct in6_addr); + opts_len -= 12 + sizeof(struct in6_addr); + break; + default: + goto trunc; + break; + } + + ND_PRINT((ndo, " PGMCC FEEDBACK %u %s", offset, nla_buf)); + break; + default: - (void)printf(" OPT_%02X [%d] ", opt_type, opt_len); + ND_PRINT((ndo, " OPT_%02X [%d] ", opt_type, opt_len)); bp += opt_len; opts_len -= opt_len; break; @@ -720,12 +770,15 @@ pgm_print(register const u_char *bp, register u_int length, } } - (void)printf(" [%u]", EXTRACT_16BITS(&pgm->pgm_length)); + ND_PRINT((ndo, " [%u]", length)); + if (ndo->ndo_packettype == PT_PGM_ZMTP1 && + (pgm->pgm_type == PGM_ODATA || pgm->pgm_type == PGM_RDATA)) + zmtp1_print_datagram(ndo, bp, EXTRACT_16BITS(&pgm->pgm_length)); return; trunc: - fputs("[|pgm]", stdout); + ND_PRINT((ndo, "[|pgm]")); if (ch != '\0') - putchar('>'); + ND_PRINT((ndo, ">")); }