blob: 8340f2c3eb43f5d05f0ba7048f78efbfa84e6635 [file] [log] [blame]
The Android Open Source Project2949f582009-03-03 19:30:46 -08001/*
2 * Redistribution and use in source and binary forms, with or without
3 * modification, are permitted provided that: (1) source code
4 * distributions retain the above copyright notice and this paragraph
5 * in its entirety, and (2) distributions including binary code include
6 * the above copyright notice and this paragraph in its entirety in
7 * the documentation or other materials provided with the distribution.
8 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
9 * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
10 * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
11 * FOR A PARTICULAR PURPOSE.
12 *
13 * Original code by Andy Heffernan (ahh@juniper.net)
14 */
15
Elliott Hughese2e3bd12017-05-15 10:59:29 -070016/* \summary: Pragmatic General Multicast (PGM) printer */
17
The Android Open Source Project2949f582009-03-03 19:30:46 -080018#ifdef HAVE_CONFIG_H
19#include "config.h"
20#endif
21
Elliott Hughese2e3bd12017-05-15 10:59:29 -070022#include <netdissect-stdinc.h>
The Android Open Source Project2949f582009-03-03 19:30:46 -080023
Elliott Hughese2e3bd12017-05-15 10:59:29 -070024#include "netdissect.h"
The Android Open Source Project2949f582009-03-03 19:30:46 -080025#include "extract.h"
26#include "addrtoname.h"
Elliott Hughese2e3bd12017-05-15 10:59:29 -070027#include "addrtostr.h"
The Android Open Source Project2949f582009-03-03 19:30:46 -080028
29#include "ip.h"
The Android Open Source Project2949f582009-03-03 19:30:46 -080030#include "ip6.h"
The Android Open Source Project2949f582009-03-03 19:30:46 -080031#include "ipproto.h"
Elliott Hughes892a68b2015-10-19 14:43:53 -070032#include "af.h"
The Android Open Source Project2949f582009-03-03 19:30:46 -080033
34/*
35 * PGM header (RFC 3208)
36 */
37struct pgm_header {
Elliott Hughes892a68b2015-10-19 14:43:53 -070038 uint16_t pgm_sport;
39 uint16_t pgm_dport;
40 uint8_t pgm_type;
41 uint8_t pgm_options;
42 uint16_t pgm_sum;
43 uint8_t pgm_gsid[6];
44 uint16_t pgm_length;
The Android Open Source Project2949f582009-03-03 19:30:46 -080045};
46
47struct pgm_spm {
Elliott Hughes892a68b2015-10-19 14:43:53 -070048 uint32_t pgms_seq;
49 uint32_t pgms_trailseq;
50 uint32_t pgms_leadseq;
51 uint16_t pgms_nla_afi;
52 uint16_t pgms_reserved;
53 /* ... uint8_t pgms_nla[0]; */
The Android Open Source Project2949f582009-03-03 19:30:46 -080054 /* ... options */
55};
56
57struct pgm_nak {
Elliott Hughes892a68b2015-10-19 14:43:53 -070058 uint32_t pgmn_seq;
59 uint16_t pgmn_source_afi;
60 uint16_t pgmn_reserved;
61 /* ... uint8_t pgmn_source[0]; */
62 /* ... uint16_t pgmn_group_afi */
63 /* ... uint16_t pgmn_reserved2; */
64 /* ... uint8_t pgmn_group[0]; */
The Android Open Source Project2949f582009-03-03 19:30:46 -080065 /* ... options */
66};
67
JP Abgrall53f17a92014-02-12 14:02:41 -080068struct pgm_ack {
Elliott Hughes892a68b2015-10-19 14:43:53 -070069 uint32_t pgma_rx_max_seq;
70 uint32_t pgma_bitmap;
JP Abgrall53f17a92014-02-12 14:02:41 -080071 /* ... options */
72};
73
The Android Open Source Project2949f582009-03-03 19:30:46 -080074struct pgm_poll {
Elliott Hughes892a68b2015-10-19 14:43:53 -070075 uint32_t pgmp_seq;
76 uint16_t pgmp_round;
77 uint16_t pgmp_reserved;
The Android Open Source Project2949f582009-03-03 19:30:46 -080078 /* ... options */
79};
80
81struct pgm_polr {
Elliott Hughes892a68b2015-10-19 14:43:53 -070082 uint32_t pgmp_seq;
83 uint16_t pgmp_round;
84 uint16_t pgmp_subtype;
85 uint16_t pgmp_nla_afi;
86 uint16_t pgmp_reserved;
87 /* ... uint8_t pgmp_nla[0]; */
The Android Open Source Project2949f582009-03-03 19:30:46 -080088 /* ... options */
89};
90
91struct pgm_data {
Elliott Hughes892a68b2015-10-19 14:43:53 -070092 uint32_t pgmd_seq;
93 uint32_t pgmd_trailseq;
The Android Open Source Project2949f582009-03-03 19:30:46 -080094 /* ... options */
95};
96
97typedef enum _pgm_type {
98 PGM_SPM = 0, /* source path message */
99 PGM_POLL = 1, /* POLL Request */
100 PGM_POLR = 2, /* POLL Response */
101 PGM_ODATA = 4, /* original data */
102 PGM_RDATA = 5, /* repair data */
103 PGM_NAK = 8, /* NAK */
104 PGM_NULLNAK = 9, /* Null NAK */
105 PGM_NCF = 10, /* NAK Confirmation */
106 PGM_ACK = 11, /* ACK for congestion control */
107 PGM_SPMR = 12, /* SPM request */
108 PGM_MAX = 255
109} pgm_type;
110
111#define PGM_OPT_BIT_PRESENT 0x01
112#define PGM_OPT_BIT_NETWORK 0x02
113#define PGM_OPT_BIT_VAR_PKTLEN 0x40
114#define PGM_OPT_BIT_PARITY 0x80
115
116#define PGM_OPT_LENGTH 0x00
117#define PGM_OPT_FRAGMENT 0x01
118#define PGM_OPT_NAK_LIST 0x02
119#define PGM_OPT_JOIN 0x03
120#define PGM_OPT_NAK_BO_IVL 0x04
121#define PGM_OPT_NAK_BO_RNG 0x05
122
123#define PGM_OPT_REDIRECT 0x07
124#define PGM_OPT_PARITY_PRM 0x08
125#define PGM_OPT_PARITY_GRP 0x09
126#define PGM_OPT_CURR_TGSIZE 0x0A
127#define PGM_OPT_NBR_UNREACH 0x0B
128#define PGM_OPT_PATH_NLA 0x0C
129
130#define PGM_OPT_SYN 0x0D
131#define PGM_OPT_FIN 0x0E
132#define PGM_OPT_RST 0x0F
133#define PGM_OPT_CR 0x10
134#define PGM_OPT_CRQST 0x11
JP Abgrall53f17a92014-02-12 14:02:41 -0800135
136#define PGM_OPT_PGMCC_DATA 0x12
137#define PGM_OPT_PGMCC_FEEDBACK 0x13
Elliott Hughes892a68b2015-10-19 14:43:53 -0700138
The Android Open Source Project2949f582009-03-03 19:30:46 -0800139#define PGM_OPT_MASK 0x7f
140
141#define PGM_OPT_END 0x80 /* end of options marker */
142
143#define PGM_MIN_OPT_LEN 4
144
The Android Open Source Project2949f582009-03-03 19:30:46 -0800145void
Elliott Hughes892a68b2015-10-19 14:43:53 -0700146pgm_print(netdissect_options *ndo,
147 register const u_char *bp, register u_int length,
148 register const u_char *bp2)
The Android Open Source Project2949f582009-03-03 19:30:46 -0800149{
150 register const struct pgm_header *pgm;
151 register const struct ip *ip;
152 register char ch;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700153 uint16_t sport, dport;
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700154 u_int nla_afnum;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800155 char nla_buf[INET6_ADDRSTRLEN];
156 register const struct ip6_hdr *ip6;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700157 uint8_t opt_type, opt_len;
158 uint32_t seq, opts_len, len, offset;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800159
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700160 pgm = (const struct pgm_header *)bp;
161 ip = (const struct ip *)bp2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800162 if (IP_V(ip) == 6)
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700163 ip6 = (const struct ip6_hdr *)bp2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800164 else
165 ip6 = NULL;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800166 ch = '\0';
Elliott Hughes892a68b2015-10-19 14:43:53 -0700167 if (!ND_TTEST(pgm->pgm_dport)) {
The Android Open Source Project2949f582009-03-03 19:30:46 -0800168 if (ip6) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700169 ND_PRINT((ndo, "%s > %s: [|pgm]",
170 ip6addr_string(ndo, &ip6->ip6_src),
171 ip6addr_string(ndo, &ip6->ip6_dst)));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700172 } else {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700173 ND_PRINT((ndo, "%s > %s: [|pgm]",
174 ipaddr_string(ndo, &ip->ip_src),
175 ipaddr_string(ndo, &ip->ip_dst)));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800176 }
Elliott Hughescec480a2017-12-19 16:54:57 -0800177 return;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800178 }
179
180 sport = EXTRACT_16BITS(&pgm->pgm_sport);
181 dport = EXTRACT_16BITS(&pgm->pgm_dport);
182
The Android Open Source Project2949f582009-03-03 19:30:46 -0800183 if (ip6) {
184 if (ip6->ip6_nxt == IPPROTO_PGM) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700185 ND_PRINT((ndo, "%s.%s > %s.%s: ",
186 ip6addr_string(ndo, &ip6->ip6_src),
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700187 tcpport_string(ndo, sport),
Elliott Hughes892a68b2015-10-19 14:43:53 -0700188 ip6addr_string(ndo, &ip6->ip6_dst),
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700189 tcpport_string(ndo, dport)));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800190 } else {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700191 ND_PRINT((ndo, "%s > %s: ",
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700192 tcpport_string(ndo, sport), tcpport_string(ndo, dport)));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800193 }
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700194 } else {
The Android Open Source Project2949f582009-03-03 19:30:46 -0800195 if (ip->ip_p == IPPROTO_PGM) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700196 ND_PRINT((ndo, "%s.%s > %s.%s: ",
197 ipaddr_string(ndo, &ip->ip_src),
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700198 tcpport_string(ndo, sport),
Elliott Hughes892a68b2015-10-19 14:43:53 -0700199 ipaddr_string(ndo, &ip->ip_dst),
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700200 tcpport_string(ndo, dport)));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800201 } else {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700202 ND_PRINT((ndo, "%s > %s: ",
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700203 tcpport_string(ndo, sport), tcpport_string(ndo, dport)));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800204 }
205 }
206
Elliott Hughes892a68b2015-10-19 14:43:53 -0700207 ND_TCHECK(*pgm);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800208
Elliott Hughes892a68b2015-10-19 14:43:53 -0700209 ND_PRINT((ndo, "PGM, length %u", EXTRACT_16BITS(&pgm->pgm_length)));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800210
Elliott Hughes892a68b2015-10-19 14:43:53 -0700211 if (!ndo->ndo_vflag)
The Android Open Source Project2949f582009-03-03 19:30:46 -0800212 return;
213
Elliott Hughes892a68b2015-10-19 14:43:53 -0700214 ND_PRINT((ndo, " 0x%02x%02x%02x%02x%02x%02x ",
The Android Open Source Project2949f582009-03-03 19:30:46 -0800215 pgm->pgm_gsid[0],
216 pgm->pgm_gsid[1],
217 pgm->pgm_gsid[2],
218 pgm->pgm_gsid[3],
219 pgm->pgm_gsid[4],
Elliott Hughes892a68b2015-10-19 14:43:53 -0700220 pgm->pgm_gsid[5]));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800221 switch (pgm->pgm_type) {
222 case PGM_SPM: {
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700223 const struct pgm_spm *spm;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800224
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700225 spm = (const struct pgm_spm *)(pgm + 1);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700226 ND_TCHECK(*spm);
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700227 bp = (const u_char *) (spm + 1);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800228
229 switch (EXTRACT_16BITS(&spm->pgms_nla_afi)) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700230 case AFNUM_INET:
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700231 ND_TCHECK2(*bp, sizeof(struct in_addr));
232 addrtostr(bp, nla_buf, sizeof(nla_buf));
233 bp += sizeof(struct in_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800234 break;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700235 case AFNUM_INET6:
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700236 ND_TCHECK2(*bp, sizeof(struct in6_addr));
237 addrtostr6(bp, nla_buf, sizeof(nla_buf));
238 bp += sizeof(struct in6_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800239 break;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800240 default:
241 goto trunc;
242 break;
243 }
The Android Open Source Project2949f582009-03-03 19:30:46 -0800244
Elliott Hughes892a68b2015-10-19 14:43:53 -0700245 ND_PRINT((ndo, "SPM seq %u trail %u lead %u nla %s",
The Android Open Source Project2949f582009-03-03 19:30:46 -0800246 EXTRACT_32BITS(&spm->pgms_seq),
247 EXTRACT_32BITS(&spm->pgms_trailseq),
248 EXTRACT_32BITS(&spm->pgms_leadseq),
Elliott Hughes892a68b2015-10-19 14:43:53 -0700249 nla_buf));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800250 break;
251 }
252
253 case PGM_POLL: {
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700254 const struct pgm_poll *poll_msg;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800255
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700256 poll_msg = (const struct pgm_poll *)(pgm + 1);
257 ND_TCHECK(*poll_msg);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700258 ND_PRINT((ndo, "POLL seq %u round %u",
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700259 EXTRACT_32BITS(&poll_msg->pgmp_seq),
260 EXTRACT_16BITS(&poll_msg->pgmp_round)));
261 bp = (const u_char *) (poll_msg + 1);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800262 break;
263 }
264 case PGM_POLR: {
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700265 const struct pgm_polr *polr;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700266 uint32_t ivl, rnd, mask;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800267
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700268 polr = (const struct pgm_polr *)(pgm + 1);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700269 ND_TCHECK(*polr);
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700270 bp = (const u_char *) (polr + 1);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800271
272 switch (EXTRACT_16BITS(&polr->pgmp_nla_afi)) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700273 case AFNUM_INET:
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700274 ND_TCHECK2(*bp, sizeof(struct in_addr));
275 addrtostr(bp, nla_buf, sizeof(nla_buf));
276 bp += sizeof(struct in_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800277 break;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700278 case AFNUM_INET6:
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700279 ND_TCHECK2(*bp, sizeof(struct in6_addr));
280 addrtostr6(bp, nla_buf, sizeof(nla_buf));
281 bp += sizeof(struct in6_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800282 break;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800283 default:
284 goto trunc;
285 break;
286 }
The Android Open Source Project2949f582009-03-03 19:30:46 -0800287
Elliott Hughes892a68b2015-10-19 14:43:53 -0700288 ND_TCHECK2(*bp, sizeof(uint32_t));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800289 ivl = EXTRACT_32BITS(bp);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700290 bp += sizeof(uint32_t);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800291
Elliott Hughes892a68b2015-10-19 14:43:53 -0700292 ND_TCHECK2(*bp, sizeof(uint32_t));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800293 rnd = EXTRACT_32BITS(bp);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700294 bp += sizeof(uint32_t);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800295
Elliott Hughes892a68b2015-10-19 14:43:53 -0700296 ND_TCHECK2(*bp, sizeof(uint32_t));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800297 mask = EXTRACT_32BITS(bp);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700298 bp += sizeof(uint32_t);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800299
Elliott Hughes892a68b2015-10-19 14:43:53 -0700300 ND_PRINT((ndo, "POLR seq %u round %u nla %s ivl %u rnd 0x%08x "
The Android Open Source Project2949f582009-03-03 19:30:46 -0800301 "mask 0x%08x", EXTRACT_32BITS(&polr->pgmp_seq),
Elliott Hughes892a68b2015-10-19 14:43:53 -0700302 EXTRACT_16BITS(&polr->pgmp_round), nla_buf, ivl, rnd, mask));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800303 break;
304 }
305 case PGM_ODATA: {
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700306 const struct pgm_data *odata;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800307
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700308 odata = (const struct pgm_data *)(pgm + 1);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700309 ND_TCHECK(*odata);
310 ND_PRINT((ndo, "ODATA trail %u seq %u",
The Android Open Source Project2949f582009-03-03 19:30:46 -0800311 EXTRACT_32BITS(&odata->pgmd_trailseq),
Elliott Hughes892a68b2015-10-19 14:43:53 -0700312 EXTRACT_32BITS(&odata->pgmd_seq)));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700313 bp = (const u_char *) (odata + 1);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800314 break;
315 }
316
317 case PGM_RDATA: {
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700318 const struct pgm_data *rdata;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800319
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700320 rdata = (const struct pgm_data *)(pgm + 1);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700321 ND_TCHECK(*rdata);
322 ND_PRINT((ndo, "RDATA trail %u seq %u",
The Android Open Source Project2949f582009-03-03 19:30:46 -0800323 EXTRACT_32BITS(&rdata->pgmd_trailseq),
Elliott Hughes892a68b2015-10-19 14:43:53 -0700324 EXTRACT_32BITS(&rdata->pgmd_seq)));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700325 bp = (const u_char *) (rdata + 1);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800326 break;
327 }
328
329 case PGM_NAK:
330 case PGM_NULLNAK:
331 case PGM_NCF: {
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700332 const struct pgm_nak *nak;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800333 char source_buf[INET6_ADDRSTRLEN], group_buf[INET6_ADDRSTRLEN];
The Android Open Source Project2949f582009-03-03 19:30:46 -0800334
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700335 nak = (const struct pgm_nak *)(pgm + 1);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700336 ND_TCHECK(*nak);
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700337 bp = (const u_char *) (nak + 1);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800338
339 /*
340 * Skip past the source, saving info along the way
341 * and stopping if we don't have enough.
342 */
343 switch (EXTRACT_16BITS(&nak->pgmn_source_afi)) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700344 case AFNUM_INET:
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700345 ND_TCHECK2(*bp, sizeof(struct in_addr));
346 addrtostr(bp, source_buf, sizeof(source_buf));
347 bp += sizeof(struct in_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800348 break;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700349 case AFNUM_INET6:
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700350 ND_TCHECK2(*bp, sizeof(struct in6_addr));
351 addrtostr6(bp, source_buf, sizeof(source_buf));
352 bp += sizeof(struct in6_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800353 break;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800354 default:
355 goto trunc;
356 break;
357 }
The Android Open Source Project2949f582009-03-03 19:30:46 -0800358
359 /*
360 * Skip past the group, saving info along the way
361 * and stopping if we don't have enough.
362 */
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700363 bp += (2 * sizeof(uint16_t));
Elliott Hughescec480a2017-12-19 16:54:57 -0800364 ND_TCHECK_16BITS(bp);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800365 switch (EXTRACT_16BITS(bp)) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700366 case AFNUM_INET:
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700367 ND_TCHECK2(*bp, sizeof(struct in_addr));
368 addrtostr(bp, group_buf, sizeof(group_buf));
369 bp += sizeof(struct in_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800370 break;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700371 case AFNUM_INET6:
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700372 ND_TCHECK2(*bp, sizeof(struct in6_addr));
373 addrtostr6(bp, group_buf, sizeof(group_buf));
374 bp += sizeof(struct in6_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800375 break;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800376 default:
377 goto trunc;
378 break;
379 }
The Android Open Source Project2949f582009-03-03 19:30:46 -0800380
381 /*
382 * Options decoding can go here.
383 */
The Android Open Source Project2949f582009-03-03 19:30:46 -0800384 switch (pgm->pgm_type) {
385 case PGM_NAK:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700386 ND_PRINT((ndo, "NAK "));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800387 break;
388 case PGM_NULLNAK:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700389 ND_PRINT((ndo, "NNAK "));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800390 break;
391 case PGM_NCF:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700392 ND_PRINT((ndo, "NCF "));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800393 break;
394 default:
395 break;
396 }
Elliott Hughes892a68b2015-10-19 14:43:53 -0700397 ND_PRINT((ndo, "(%s -> %s), seq %u",
398 source_buf, group_buf, EXTRACT_32BITS(&nak->pgmn_seq)));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800399 break;
400 }
401
JP Abgrall53f17a92014-02-12 14:02:41 -0800402 case PGM_ACK: {
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700403 const struct pgm_ack *ack;
JP Abgrall53f17a92014-02-12 14:02:41 -0800404
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700405 ack = (const struct pgm_ack *)(pgm + 1);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700406 ND_TCHECK(*ack);
407 ND_PRINT((ndo, "ACK seq %u",
408 EXTRACT_32BITS(&ack->pgma_rx_max_seq)));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700409 bp = (const u_char *) (ack + 1);
JP Abgrall53f17a92014-02-12 14:02:41 -0800410 break;
411 }
412
The Android Open Source Project2949f582009-03-03 19:30:46 -0800413 case PGM_SPMR:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700414 ND_PRINT((ndo, "SPMR"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800415 break;
416
417 default:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700418 ND_PRINT((ndo, "UNKNOWN type 0x%02x", pgm->pgm_type));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800419 break;
420
421 }
Elliott Hughes892a68b2015-10-19 14:43:53 -0700422 if (pgm->pgm_options & PGM_OPT_BIT_PRESENT) {
The Android Open Source Project2949f582009-03-03 19:30:46 -0800423
424 /*
425 * make sure there's enough for the first option header
426 */
Elliott Hughes892a68b2015-10-19 14:43:53 -0700427 if (!ND_TTEST2(*bp, PGM_MIN_OPT_LEN)) {
428 ND_PRINT((ndo, "[|OPT]"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800429 return;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700430 }
The Android Open Source Project2949f582009-03-03 19:30:46 -0800431
432 /*
433 * That option header MUST be an OPT_LENGTH option
434 * (see the first paragraph of section 9.1 in RFC 3208).
435 */
436 opt_type = *bp++;
437 if ((opt_type & PGM_OPT_MASK) != PGM_OPT_LENGTH) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700438 ND_PRINT((ndo, "[First option bad, should be PGM_OPT_LENGTH, is %u]", opt_type & PGM_OPT_MASK));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800439 return;
440 }
441 opt_len = *bp++;
442 if (opt_len != 4) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700443 ND_PRINT((ndo, "[Bad OPT_LENGTH option, length %u != 4]", opt_len));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800444 return;
445 }
446 opts_len = EXTRACT_16BITS(bp);
447 if (opts_len < 4) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700448 ND_PRINT((ndo, "[Bad total option length %u < 4]", opts_len));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800449 return;
450 }
Elliott Hughes892a68b2015-10-19 14:43:53 -0700451 bp += sizeof(uint16_t);
452 ND_PRINT((ndo, " OPTS LEN %d", opts_len));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800453 opts_len -= 4;
454
455 while (opts_len) {
456 if (opts_len < PGM_MIN_OPT_LEN) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700457 ND_PRINT((ndo, "[Total option length leaves no room for final option]"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800458 return;
459 }
Elliott Hughescec480a2017-12-19 16:54:57 -0800460 if (!ND_TTEST2(*bp, 2)) {
461 ND_PRINT((ndo, " [|OPT]"));
462 return;
463 }
The Android Open Source Project2949f582009-03-03 19:30:46 -0800464 opt_type = *bp++;
465 opt_len = *bp++;
466 if (opt_len < PGM_MIN_OPT_LEN) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700467 ND_PRINT((ndo, "[Bad option, length %u < %u]", opt_len,
468 PGM_MIN_OPT_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800469 break;
470 }
471 if (opts_len < opt_len) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700472 ND_PRINT((ndo, "[Total option length leaves no room for final option]"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800473 return;
474 }
Elliott Hughes892a68b2015-10-19 14:43:53 -0700475 if (!ND_TTEST2(*bp, opt_len - 2)) {
476 ND_PRINT((ndo, " [|OPT]"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800477 return;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700478 }
The Android Open Source Project2949f582009-03-03 19:30:46 -0800479
480 switch (opt_type & PGM_OPT_MASK) {
481 case PGM_OPT_LENGTH:
Elliott Hughescec480a2017-12-19 16:54:57 -0800482#define PGM_OPT_LENGTH_LEN (2+2)
483 if (opt_len != PGM_OPT_LENGTH_LEN) {
484 ND_PRINT((ndo, "[Bad OPT_LENGTH option, length %u != %u]",
485 opt_len, PGM_OPT_LENGTH_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800486 return;
487 }
Elliott Hughes892a68b2015-10-19 14:43:53 -0700488 ND_PRINT((ndo, " OPTS LEN (extra?) %d", EXTRACT_16BITS(bp)));
Elliott Hughescec480a2017-12-19 16:54:57 -0800489 bp += 2;
490 opts_len -= PGM_OPT_LENGTH_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800491 break;
492
493 case PGM_OPT_FRAGMENT:
Elliott Hughescec480a2017-12-19 16:54:57 -0800494#define PGM_OPT_FRAGMENT_LEN (2+2+4+4+4)
495 if (opt_len != PGM_OPT_FRAGMENT_LEN) {
496 ND_PRINT((ndo, "[Bad OPT_FRAGMENT option, length %u != %u]",
497 opt_len, PGM_OPT_FRAGMENT_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800498 return;
499 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800500 bp += 2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800501 seq = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800502 bp += 4;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800503 offset = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800504 bp += 4;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800505 len = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800506 bp += 4;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700507 ND_PRINT((ndo, " FRAG seq %u off %u len %u", seq, offset, len));
Elliott Hughescec480a2017-12-19 16:54:57 -0800508 opts_len -= PGM_OPT_FRAGMENT_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800509 break;
510
511 case PGM_OPT_NAK_LIST:
JP Abgrall53f17a92014-02-12 14:02:41 -0800512 bp += 2;
Elliott Hughescec480a2017-12-19 16:54:57 -0800513 opt_len -= 4; /* option header */
Elliott Hughes892a68b2015-10-19 14:43:53 -0700514 ND_PRINT((ndo, " NAK LIST"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800515 while (opt_len) {
Elliott Hughescec480a2017-12-19 16:54:57 -0800516 if (opt_len < 4) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700517 ND_PRINT((ndo, "[Option length not a multiple of 4]"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800518 return;
519 }
Elliott Hughescec480a2017-12-19 16:54:57 -0800520 ND_TCHECK2(*bp, 4);
Elliott Hughes892a68b2015-10-19 14:43:53 -0700521 ND_PRINT((ndo, " %u", EXTRACT_32BITS(bp)));
Elliott Hughescec480a2017-12-19 16:54:57 -0800522 bp += 4;
523 opt_len -= 4;
524 opts_len -= 4;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800525 }
526 break;
527
528 case PGM_OPT_JOIN:
Elliott Hughescec480a2017-12-19 16:54:57 -0800529#define PGM_OPT_JOIN_LEN (2+2+4)
530 if (opt_len != PGM_OPT_JOIN_LEN) {
531 ND_PRINT((ndo, "[Bad OPT_JOIN option, length %u != %u]",
532 opt_len, PGM_OPT_JOIN_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800533 return;
534 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800535 bp += 2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800536 seq = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800537 bp += 4;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700538 ND_PRINT((ndo, " JOIN %u", seq));
Elliott Hughescec480a2017-12-19 16:54:57 -0800539 opts_len -= PGM_OPT_JOIN_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800540 break;
541
542 case PGM_OPT_NAK_BO_IVL:
Elliott Hughescec480a2017-12-19 16:54:57 -0800543#define PGM_OPT_NAK_BO_IVL_LEN (2+2+4+4)
544 if (opt_len != PGM_OPT_NAK_BO_IVL_LEN) {
545 ND_PRINT((ndo, "[Bad OPT_NAK_BO_IVL option, length %u != %u]",
546 opt_len, PGM_OPT_NAK_BO_IVL_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800547 return;
548 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800549 bp += 2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800550 offset = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800551 bp += 4;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800552 seq = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800553 bp += 4;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700554 ND_PRINT((ndo, " BACKOFF ivl %u ivlseq %u", offset, seq));
Elliott Hughescec480a2017-12-19 16:54:57 -0800555 opts_len -= PGM_OPT_NAK_BO_IVL_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800556 break;
557
558 case PGM_OPT_NAK_BO_RNG:
Elliott Hughescec480a2017-12-19 16:54:57 -0800559#define PGM_OPT_NAK_BO_RNG_LEN (2+2+4+4)
560 if (opt_len != PGM_OPT_NAK_BO_RNG_LEN) {
561 ND_PRINT((ndo, "[Bad OPT_NAK_BO_RNG option, length %u != %u]",
562 opt_len, PGM_OPT_NAK_BO_RNG_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800563 return;
564 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800565 bp += 2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800566 offset = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800567 bp += 4;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800568 seq = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800569 bp += 4;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700570 ND_PRINT((ndo, " BACKOFF max %u min %u", offset, seq));
Elliott Hughescec480a2017-12-19 16:54:57 -0800571 opts_len -= PGM_OPT_NAK_BO_RNG_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800572 break;
573
574 case PGM_OPT_REDIRECT:
Elliott Hughescec480a2017-12-19 16:54:57 -0800575#define PGM_OPT_REDIRECT_FIXED_LEN (2+2+2+2)
576 if (opt_len < PGM_OPT_REDIRECT_FIXED_LEN) {
577 ND_PRINT((ndo, "[Bad OPT_REDIRECT option, length %u < %u]",
578 opt_len, PGM_OPT_REDIRECT_FIXED_LEN));
579 return;
580 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800581 bp += 2;
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700582 nla_afnum = EXTRACT_16BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800583 bp += 2+2;
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700584 switch (nla_afnum) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700585 case AFNUM_INET:
Elliott Hughescec480a2017-12-19 16:54:57 -0800586 if (opt_len != PGM_OPT_REDIRECT_FIXED_LEN + sizeof(struct in_addr)) {
587 ND_PRINT((ndo, "[Bad OPT_REDIRECT option, length %u != %u + address size]",
588 opt_len, PGM_OPT_REDIRECT_FIXED_LEN));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700589 return;
590 }
591 ND_TCHECK2(*bp, sizeof(struct in_addr));
592 addrtostr(bp, nla_buf, sizeof(nla_buf));
593 bp += sizeof(struct in_addr);
Elliott Hughescec480a2017-12-19 16:54:57 -0800594 opts_len -= PGM_OPT_REDIRECT_FIXED_LEN + sizeof(struct in_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800595 break;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700596 case AFNUM_INET6:
Elliott Hughescec480a2017-12-19 16:54:57 -0800597 if (opt_len != PGM_OPT_REDIRECT_FIXED_LEN + sizeof(struct in6_addr)) {
598 ND_PRINT((ndo, "[Bad OPT_REDIRECT option, length %u != %u + address size]",
599 PGM_OPT_REDIRECT_FIXED_LEN, opt_len));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700600 return;
601 }
602 ND_TCHECK2(*bp, sizeof(struct in6_addr));
603 addrtostr6(bp, nla_buf, sizeof(nla_buf));
604 bp += sizeof(struct in6_addr);
Elliott Hughescec480a2017-12-19 16:54:57 -0800605 opts_len -= PGM_OPT_REDIRECT_FIXED_LEN + sizeof(struct in6_addr);
The Android Open Source Project2949f582009-03-03 19:30:46 -0800606 break;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800607 default:
608 goto trunc;
609 break;
610 }
The Android Open Source Project2949f582009-03-03 19:30:46 -0800611
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700612 ND_PRINT((ndo, " REDIRECT %s", nla_buf));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800613 break;
614
615 case PGM_OPT_PARITY_PRM:
Elliott Hughescec480a2017-12-19 16:54:57 -0800616#define PGM_OPT_PARITY_PRM_LEN (2+2+4)
617 if (opt_len != PGM_OPT_PARITY_PRM_LEN) {
618 ND_PRINT((ndo, "[Bad OPT_PARITY_PRM option, length %u != %u]",
619 opt_len, PGM_OPT_PARITY_PRM_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800620 return;
621 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800622 bp += 2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800623 len = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800624 bp += 4;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700625 ND_PRINT((ndo, " PARITY MAXTGS %u", len));
Elliott Hughescec480a2017-12-19 16:54:57 -0800626 opts_len -= PGM_OPT_PARITY_PRM_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800627 break;
628
629 case PGM_OPT_PARITY_GRP:
Elliott Hughescec480a2017-12-19 16:54:57 -0800630#define PGM_OPT_PARITY_GRP_LEN (2+2+4)
631 if (opt_len != PGM_OPT_PARITY_GRP_LEN) {
632 ND_PRINT((ndo, "[Bad OPT_PARITY_GRP option, length %u != %u]",
633 opt_len, PGM_OPT_PARITY_GRP_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800634 return;
635 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800636 bp += 2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800637 seq = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800638 bp += 4;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700639 ND_PRINT((ndo, " PARITY GROUP %u", seq));
Elliott Hughescec480a2017-12-19 16:54:57 -0800640 opts_len -= PGM_OPT_PARITY_GRP_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800641 break;
642
643 case PGM_OPT_CURR_TGSIZE:
Elliott Hughescec480a2017-12-19 16:54:57 -0800644#define PGM_OPT_CURR_TGSIZE_LEN (2+2+4)
645 if (opt_len != PGM_OPT_CURR_TGSIZE_LEN) {
646 ND_PRINT((ndo, "[Bad OPT_CURR_TGSIZE option, length %u != %u]",
647 opt_len, PGM_OPT_CURR_TGSIZE_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800648 return;
649 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800650 bp += 2;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800651 len = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800652 bp += 4;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700653 ND_PRINT((ndo, " PARITY ATGS %u", len));
Elliott Hughescec480a2017-12-19 16:54:57 -0800654 opts_len -= PGM_OPT_CURR_TGSIZE_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800655 break;
656
657 case PGM_OPT_NBR_UNREACH:
Elliott Hughescec480a2017-12-19 16:54:57 -0800658#define PGM_OPT_NBR_UNREACH_LEN (2+2)
659 if (opt_len != PGM_OPT_NBR_UNREACH_LEN) {
660 ND_PRINT((ndo, "[Bad OPT_NBR_UNREACH option, length %u != %u]",
661 opt_len, PGM_OPT_NBR_UNREACH_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800662 return;
663 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800664 bp += 2;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700665 ND_PRINT((ndo, " NBR_UNREACH"));
Elliott Hughescec480a2017-12-19 16:54:57 -0800666 opts_len -= PGM_OPT_NBR_UNREACH_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800667 break;
668
669 case PGM_OPT_PATH_NLA:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700670 ND_PRINT((ndo, " PATH_NLA [%d]", opt_len));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800671 bp += opt_len;
672 opts_len -= opt_len;
673 break;
674
675 case PGM_OPT_SYN:
Elliott Hughescec480a2017-12-19 16:54:57 -0800676#define PGM_OPT_SYN_LEN (2+2)
677 if (opt_len != PGM_OPT_SYN_LEN) {
678 ND_PRINT((ndo, "[Bad OPT_SYN option, length %u != %u]",
679 opt_len, PGM_OPT_SYN_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800680 return;
681 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800682 bp += 2;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700683 ND_PRINT((ndo, " SYN"));
Elliott Hughescec480a2017-12-19 16:54:57 -0800684 opts_len -= PGM_OPT_SYN_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800685 break;
686
687 case PGM_OPT_FIN:
Elliott Hughescec480a2017-12-19 16:54:57 -0800688#define PGM_OPT_FIN_LEN (2+2)
689 if (opt_len != PGM_OPT_FIN_LEN) {
690 ND_PRINT((ndo, "[Bad OPT_FIN option, length %u != %u]",
691 opt_len, PGM_OPT_FIN_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800692 return;
693 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800694 bp += 2;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700695 ND_PRINT((ndo, " FIN"));
Elliott Hughescec480a2017-12-19 16:54:57 -0800696 opts_len -= PGM_OPT_FIN_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800697 break;
698
699 case PGM_OPT_RST:
Elliott Hughescec480a2017-12-19 16:54:57 -0800700#define PGM_OPT_RST_LEN (2+2)
701 if (opt_len != PGM_OPT_RST_LEN) {
702 ND_PRINT((ndo, "[Bad OPT_RST option, length %u != %u]",
703 opt_len, PGM_OPT_RST_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800704 return;
705 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800706 bp += 2;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700707 ND_PRINT((ndo, " RST"));
Elliott Hughescec480a2017-12-19 16:54:57 -0800708 opts_len -= PGM_OPT_RST_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800709 break;
710
711 case PGM_OPT_CR:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700712 ND_PRINT((ndo, " CR"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800713 bp += opt_len;
714 opts_len -= opt_len;
715 break;
716
717 case PGM_OPT_CRQST:
Elliott Hughescec480a2017-12-19 16:54:57 -0800718#define PGM_OPT_CRQST_LEN (2+2)
719 if (opt_len != PGM_OPT_CRQST_LEN) {
720 ND_PRINT((ndo, "[Bad OPT_CRQST option, length %u != %u]",
721 opt_len, PGM_OPT_CRQST_LEN));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800722 return;
723 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800724 bp += 2;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700725 ND_PRINT((ndo, " CRQST"));
Elliott Hughescec480a2017-12-19 16:54:57 -0800726 opts_len -= PGM_OPT_CRQST_LEN;
The Android Open Source Project2949f582009-03-03 19:30:46 -0800727 break;
728
JP Abgrall53f17a92014-02-12 14:02:41 -0800729 case PGM_OPT_PGMCC_DATA:
Elliott Hughescec480a2017-12-19 16:54:57 -0800730#define PGM_OPT_PGMCC_DATA_FIXED_LEN (2+2+4+2+2)
731 if (opt_len < PGM_OPT_PGMCC_DATA_FIXED_LEN) {
732 ND_PRINT((ndo, "[Bad OPT_PGMCC_DATA option, length %u < %u]",
733 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN));
734 return;
735 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800736 bp += 2;
737 offset = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800738 bp += 4;
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700739 nla_afnum = EXTRACT_16BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800740 bp += 2+2;
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700741 switch (nla_afnum) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700742 case AFNUM_INET:
Elliott Hughescec480a2017-12-19 16:54:57 -0800743 if (opt_len != PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(struct in_addr)) {
744 ND_PRINT((ndo, "[Bad OPT_PGMCC_DATA option, length %u != %u + address size]",
745 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700746 return;
747 }
748 ND_TCHECK2(*bp, sizeof(struct in_addr));
749 addrtostr(bp, nla_buf, sizeof(nla_buf));
750 bp += sizeof(struct in_addr);
Elliott Hughescec480a2017-12-19 16:54:57 -0800751 opts_len -= PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(struct in_addr);
JP Abgrall53f17a92014-02-12 14:02:41 -0800752 break;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700753 case AFNUM_INET6:
Elliott Hughescec480a2017-12-19 16:54:57 -0800754 if (opt_len != PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(struct in6_addr)) {
755 ND_PRINT((ndo, "[Bad OPT_PGMCC_DATA option, length %u != %u + address size]",
756 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700757 return;
758 }
759 ND_TCHECK2(*bp, sizeof(struct in6_addr));
760 addrtostr6(bp, nla_buf, sizeof(nla_buf));
761 bp += sizeof(struct in6_addr);
Elliott Hughescec480a2017-12-19 16:54:57 -0800762 opts_len -= PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(struct in6_addr);
JP Abgrall53f17a92014-02-12 14:02:41 -0800763 break;
JP Abgrall53f17a92014-02-12 14:02:41 -0800764 default:
765 goto trunc;
766 break;
767 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800768
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700769 ND_PRINT((ndo, " PGMCC DATA %u %s", offset, nla_buf));
JP Abgrall53f17a92014-02-12 14:02:41 -0800770 break;
771
772 case PGM_OPT_PGMCC_FEEDBACK:
Elliott Hughescec480a2017-12-19 16:54:57 -0800773#define PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN (2+2+4+2+2)
774 if (opt_len < PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN) {
775 ND_PRINT((ndo, "[Bad PGM_OPT_PGMCC_FEEDBACK option, length %u < %u]",
776 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN));
777 return;
778 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800779 bp += 2;
780 offset = EXTRACT_32BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800781 bp += 4;
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700782 nla_afnum = EXTRACT_16BITS(bp);
Elliott Hughescec480a2017-12-19 16:54:57 -0800783 bp += 2+2;
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700784 switch (nla_afnum) {
Elliott Hughes892a68b2015-10-19 14:43:53 -0700785 case AFNUM_INET:
Elliott Hughescec480a2017-12-19 16:54:57 -0800786 if (opt_len != PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(struct in_addr)) {
787 ND_PRINT((ndo, "[Bad OPT_PGMCC_FEEDBACK option, length %u != %u + address size]",
788 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700789 return;
790 }
791 ND_TCHECK2(*bp, sizeof(struct in_addr));
792 addrtostr(bp, nla_buf, sizeof(nla_buf));
793 bp += sizeof(struct in_addr);
Elliott Hughescec480a2017-12-19 16:54:57 -0800794 opts_len -= PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(struct in_addr);
JP Abgrall53f17a92014-02-12 14:02:41 -0800795 break;
Elliott Hughes892a68b2015-10-19 14:43:53 -0700796 case AFNUM_INET6:
Elliott Hughescec480a2017-12-19 16:54:57 -0800797 if (opt_len != PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(struct in6_addr)) {
798 ND_PRINT((ndo, "[Bad OPT_PGMCC_FEEDBACK option, length %u != %u + address size]",
799 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN));
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700800 return;
801 }
802 ND_TCHECK2(*bp, sizeof(struct in6_addr));
803 addrtostr6(bp, nla_buf, sizeof(nla_buf));
804 bp += sizeof(struct in6_addr);
Elliott Hughescec480a2017-12-19 16:54:57 -0800805 opts_len -= PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(struct in6_addr);
JP Abgrall53f17a92014-02-12 14:02:41 -0800806 break;
JP Abgrall53f17a92014-02-12 14:02:41 -0800807 default:
808 goto trunc;
809 break;
810 }
JP Abgrall53f17a92014-02-12 14:02:41 -0800811
Elliott Hughese2e3bd12017-05-15 10:59:29 -0700812 ND_PRINT((ndo, " PGMCC FEEDBACK %u %s", offset, nla_buf));
JP Abgrall53f17a92014-02-12 14:02:41 -0800813 break;
814
The Android Open Source Project2949f582009-03-03 19:30:46 -0800815 default:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700816 ND_PRINT((ndo, " OPT_%02X [%d] ", opt_type, opt_len));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800817 bp += opt_len;
818 opts_len -= opt_len;
819 break;
820 }
821
822 if (opt_type & PGM_OPT_END)
823 break;
824 }
825 }
826
Elliott Hughes892a68b2015-10-19 14:43:53 -0700827 ND_PRINT((ndo, " [%u]", length));
828 if (ndo->ndo_packettype == PT_PGM_ZMTP1 &&
JP Abgrall53f17a92014-02-12 14:02:41 -0800829 (pgm->pgm_type == PGM_ODATA || pgm->pgm_type == PGM_RDATA))
Elliott Hughes892a68b2015-10-19 14:43:53 -0700830 zmtp1_print_datagram(ndo, bp, EXTRACT_16BITS(&pgm->pgm_length));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800831
832 return;
833
834trunc:
Elliott Hughes892a68b2015-10-19 14:43:53 -0700835 ND_PRINT((ndo, "[|pgm]"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800836 if (ch != '\0')
Elliott Hughes892a68b2015-10-19 14:43:53 -0700837 ND_PRINT((ndo, ">"));
The Android Open Source Project2949f582009-03-03 19:30:46 -0800838}