]> The Tcpdump Group git mirrors - tcpdump/blob - print-pgm.c
0f88db6df12083e20d7769a2d0c1f12d1ac5c4b1
[tcpdump] / print-pgm.c
1 /*
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
16 /* \summary: Pragmatic General Multicast (PGM) printer */
17
18 #ifdef HAVE_CONFIG_H
19 #include <config.h>
20 #endif
21
22 #include "netdissect-stdinc.h"
23
24 #include "netdissect.h"
25 #include "extract.h"
26 #include "addrtoname.h"
27 #include "addrtostr.h"
28
29 #include "ip.h"
30 #include "ip6.h"
31 #include "ipproto.h"
32 #include "af.h"
33
34 /*
35 * PGM header (RFC 3208)
36 */
37 struct pgm_header {
38 nd_uint16_t pgm_sport;
39 nd_uint16_t pgm_dport;
40 nd_uint8_t pgm_type;
41 nd_uint8_t pgm_options;
42 nd_uint16_t pgm_sum;
43 nd_byte pgm_gsid[6];
44 nd_uint16_t pgm_length;
45 };
46
47 struct pgm_spm {
48 nd_uint32_t pgms_seq;
49 nd_uint32_t pgms_trailseq;
50 nd_uint32_t pgms_leadseq;
51 nd_uint16_t pgms_nla_afi;
52 nd_uint16_t pgms_reserved;
53 /* ... uint8_t pgms_nla[0]; */
54 /* ... options */
55 };
56
57 struct pgm_nak {
58 nd_uint32_t pgmn_seq;
59 nd_uint16_t pgmn_source_afi;
60 nd_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]; */
65 /* ... options */
66 };
67
68 struct pgm_ack {
69 nd_uint32_t pgma_rx_max_seq;
70 nd_uint32_t pgma_bitmap;
71 /* ... options */
72 };
73
74 struct pgm_poll {
75 nd_uint32_t pgmp_seq;
76 nd_uint16_t pgmp_round;
77 nd_uint16_t pgmp_subtype;
78 nd_uint16_t pgmp_nla_afi;
79 nd_uint16_t pgmp_reserved;
80 /* ... uint8_t pgmp_nla[0]; */
81 /* ... options */
82 };
83
84 struct pgm_polr {
85 nd_uint32_t pgmp_seq;
86 nd_uint16_t pgmp_round;
87 nd_uint16_t pgmp_reserved;
88 /* ... options */
89 };
90
91 struct pgm_data {
92 nd_uint32_t pgmd_seq;
93 nd_uint32_t pgmd_trailseq;
94 /* ... options */
95 };
96
97 typedef 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
135
136 #define PGM_OPT_PGMCC_DATA 0x12
137 #define PGM_OPT_PGMCC_FEEDBACK 0x13
138
139 #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
145 void
146 pgm_print(netdissect_options *ndo,
147 const u_char *bp, u_int length,
148 const u_char *bp2)
149 {
150 const struct pgm_header *pgm;
151 const struct ip *ip;
152 uint8_t pgm_type_val;
153 uint16_t sport, dport;
154 u_int nla_afnum;
155 char nla_buf[INET6_ADDRSTRLEN];
156 const struct ip6_hdr *ip6;
157 uint8_t opt_type, opt_len;
158 uint32_t seq, opts_len, len, offset;
159
160 ndo->ndo_protocol = "pgm";
161 pgm = (const struct pgm_header *)bp;
162 ip = (const struct ip *)bp2;
163 if (IP_V(ip) == 6)
164 ip6 = (const struct ip6_hdr *)bp2;
165 else
166 ip6 = NULL;
167 if (!ND_TTEST_2(pgm->pgm_dport)) {
168 if (ip6) {
169 ND_PRINT("%s > %s:",
170 ip6addr_string(ndo, ip6->ip6_src),
171 ip6addr_string(ndo, ip6->ip6_dst));
172 } else {
173 ND_PRINT("%s > %s:",
174 ipaddr_string(ndo, ip->ip_src),
175 ipaddr_string(ndo, ip->ip_dst));
176 }
177 nd_print_trunc(ndo);
178 return;
179 }
180
181 sport = GET_BE_U_2(pgm->pgm_sport);
182 dport = GET_BE_U_2(pgm->pgm_dport);
183
184 if (ip6) {
185 if (GET_U_1(ip6->ip6_nxt) == IPPROTO_PGM) {
186 ND_PRINT("%s.%s > %s.%s: ",
187 ip6addr_string(ndo, ip6->ip6_src),
188 tcpport_string(ndo, sport),
189 ip6addr_string(ndo, ip6->ip6_dst),
190 tcpport_string(ndo, dport));
191 } else {
192 ND_PRINT("%s > %s: ",
193 tcpport_string(ndo, sport), tcpport_string(ndo, dport));
194 }
195 } else {
196 if (GET_U_1(ip->ip_p) == IPPROTO_PGM) {
197 ND_PRINT("%s.%s > %s.%s: ",
198 ipaddr_string(ndo, ip->ip_src),
199 tcpport_string(ndo, sport),
200 ipaddr_string(ndo, ip->ip_dst),
201 tcpport_string(ndo, dport));
202 } else {
203 ND_PRINT("%s > %s: ",
204 tcpport_string(ndo, sport), tcpport_string(ndo, dport));
205 }
206 }
207
208 ND_TCHECK_SIZE(pgm);
209
210 ND_PRINT("PGM, length %u", GET_BE_U_2(pgm->pgm_length));
211
212 if (!ndo->ndo_vflag)
213 return;
214
215 pgm_type_val = GET_U_1(pgm->pgm_type);
216 ND_PRINT(" 0x%02x%02x%02x%02x%02x%02x ",
217 pgm->pgm_gsid[0],
218 pgm->pgm_gsid[1],
219 pgm->pgm_gsid[2],
220 pgm->pgm_gsid[3],
221 pgm->pgm_gsid[4],
222 pgm->pgm_gsid[5]);
223 switch (pgm_type_val) {
224 case PGM_SPM: {
225 const struct pgm_spm *spm;
226
227 spm = (const struct pgm_spm *)(pgm + 1);
228 ND_TCHECK_SIZE(spm);
229 bp = (const u_char *) (spm + 1);
230
231 switch (GET_BE_U_2(spm->pgms_nla_afi)) {
232 case AFNUM_INET:
233 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
234 addrtostr(bp, nla_buf, sizeof(nla_buf));
235 bp += sizeof(nd_ipv4);
236 break;
237 case AFNUM_INET6:
238 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
239 addrtostr6(bp, nla_buf, sizeof(nla_buf));
240 bp += sizeof(nd_ipv6);
241 break;
242 default:
243 goto trunc;
244 break;
245 }
246
247 ND_PRINT("SPM seq %u trail %u lead %u nla %s",
248 GET_BE_U_4(spm->pgms_seq),
249 GET_BE_U_4(spm->pgms_trailseq),
250 GET_BE_U_4(spm->pgms_leadseq),
251 nla_buf);
252 break;
253 }
254
255 case PGM_POLL: {
256 const struct pgm_poll *pgm_poll;
257 uint32_t ivl, rnd, mask;
258
259 pgm_poll = (const struct pgm_poll *)(pgm + 1);
260 ND_TCHECK_SIZE(pgm_poll);
261 bp = (const u_char *) (pgm_poll + 1);
262
263 switch (GET_BE_U_2(pgm_poll->pgmp_nla_afi)) {
264 case AFNUM_INET:
265 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
266 addrtostr(bp, nla_buf, sizeof(nla_buf));
267 bp += sizeof(nd_ipv4);
268 break;
269 case AFNUM_INET6:
270 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
271 addrtostr6(bp, nla_buf, sizeof(nla_buf));
272 bp += sizeof(nd_ipv6);
273 break;
274 default:
275 goto trunc;
276 break;
277 }
278
279 ND_TCHECK_LEN(bp, sizeof(uint32_t));
280 ivl = GET_BE_U_4(bp);
281 bp += sizeof(uint32_t);
282
283 ND_TCHECK_LEN(bp, sizeof(uint32_t));
284 rnd = GET_BE_U_4(bp);
285 bp += sizeof(uint32_t);
286
287 ND_TCHECK_LEN(bp, sizeof(uint32_t));
288 mask = GET_BE_U_4(bp);
289 bp += sizeof(uint32_t);
290
291 ND_PRINT("POLL seq %u round %u nla %s ivl %u rnd 0x%08x "
292 "mask 0x%08x", GET_BE_U_4(pgm_poll->pgmp_seq),
293 GET_BE_U_2(pgm_poll->pgmp_round), nla_buf, ivl, rnd,
294 mask);
295 break;
296 }
297 case PGM_POLR: {
298 const struct pgm_polr *polr_msg;
299
300 polr_msg = (const struct pgm_polr *)(pgm + 1);
301 ND_TCHECK_SIZE(polr_msg);
302 ND_PRINT("POLR seq %u round %u",
303 GET_BE_U_4(polr_msg->pgmp_seq),
304 GET_BE_U_2(polr_msg->pgmp_round));
305 bp = (const u_char *) (polr_msg + 1);
306 break;
307 }
308 case PGM_ODATA: {
309 const struct pgm_data *odata;
310
311 odata = (const struct pgm_data *)(pgm + 1);
312 ND_TCHECK_SIZE(odata);
313 ND_PRINT("ODATA trail %u seq %u",
314 GET_BE_U_4(odata->pgmd_trailseq),
315 GET_BE_U_4(odata->pgmd_seq));
316 bp = (const u_char *) (odata + 1);
317 break;
318 }
319
320 case PGM_RDATA: {
321 const struct pgm_data *rdata;
322
323 rdata = (const struct pgm_data *)(pgm + 1);
324 ND_TCHECK_SIZE(rdata);
325 ND_PRINT("RDATA trail %u seq %u",
326 GET_BE_U_4(rdata->pgmd_trailseq),
327 GET_BE_U_4(rdata->pgmd_seq));
328 bp = (const u_char *) (rdata + 1);
329 break;
330 }
331
332 case PGM_NAK:
333 case PGM_NULLNAK:
334 case PGM_NCF: {
335 const struct pgm_nak *nak;
336 char source_buf[INET6_ADDRSTRLEN], group_buf[INET6_ADDRSTRLEN];
337
338 nak = (const struct pgm_nak *)(pgm + 1);
339 ND_TCHECK_SIZE(nak);
340 bp = (const u_char *) (nak + 1);
341
342 /*
343 * Skip past the source, saving info along the way
344 * and stopping if we don't have enough.
345 */
346 switch (GET_BE_U_2(nak->pgmn_source_afi)) {
347 case AFNUM_INET:
348 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
349 addrtostr(bp, source_buf, sizeof(source_buf));
350 bp += sizeof(nd_ipv4);
351 break;
352 case AFNUM_INET6:
353 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
354 addrtostr6(bp, source_buf, sizeof(source_buf));
355 bp += sizeof(nd_ipv6);
356 break;
357 default:
358 goto trunc;
359 break;
360 }
361
362 /*
363 * Skip past the group, saving info along the way
364 * and stopping if we don't have enough.
365 */
366 bp += (2 * sizeof(uint16_t));
367 switch (GET_BE_U_2(bp)) {
368 case AFNUM_INET:
369 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
370 addrtostr(bp, group_buf, sizeof(group_buf));
371 bp += sizeof(nd_ipv4);
372 break;
373 case AFNUM_INET6:
374 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
375 addrtostr6(bp, group_buf, sizeof(group_buf));
376 bp += sizeof(nd_ipv6);
377 break;
378 default:
379 goto trunc;
380 break;
381 }
382
383 /*
384 * Options decoding can go here.
385 */
386 switch (pgm_type_val) {
387 case PGM_NAK:
388 ND_PRINT("NAK ");
389 break;
390 case PGM_NULLNAK:
391 ND_PRINT("NNAK ");
392 break;
393 case PGM_NCF:
394 ND_PRINT("NCF ");
395 break;
396 default:
397 break;
398 }
399 ND_PRINT("(%s -> %s), seq %u",
400 source_buf, group_buf, GET_BE_U_4(nak->pgmn_seq));
401 break;
402 }
403
404 case PGM_ACK: {
405 const struct pgm_ack *ack;
406
407 ack = (const struct pgm_ack *)(pgm + 1);
408 ND_TCHECK_SIZE(ack);
409 ND_PRINT("ACK seq %u",
410 GET_BE_U_4(ack->pgma_rx_max_seq));
411 bp = (const u_char *) (ack + 1);
412 break;
413 }
414
415 case PGM_SPMR:
416 ND_PRINT("SPMR");
417 break;
418
419 default:
420 ND_PRINT("UNKNOWN type 0x%02x", pgm_type_val);
421 break;
422
423 }
424 if (GET_U_1(pgm->pgm_options) & PGM_OPT_BIT_PRESENT) {
425
426 /*
427 * make sure there's enough for the first option header
428 */
429 ND_TCHECK_LEN(bp, PGM_MIN_OPT_LEN);
430
431 /*
432 * That option header MUST be an OPT_LENGTH option
433 * (see the first paragraph of section 9.1 in RFC 3208).
434 */
435 opt_type = GET_U_1(bp);
436 bp++;
437 if ((opt_type & PGM_OPT_MASK) != PGM_OPT_LENGTH) {
438 ND_PRINT("[First option bad, should be PGM_OPT_LENGTH, is %u]", opt_type & PGM_OPT_MASK);
439 return;
440 }
441 opt_len = GET_U_1(bp);
442 bp++;
443 if (opt_len != 4) {
444 ND_PRINT("[Bad OPT_LENGTH option, length %u != 4]", opt_len);
445 return;
446 }
447 opts_len = GET_BE_U_2(bp);
448 bp += sizeof(uint16_t);
449 if (opts_len < 4) {
450 ND_PRINT("[Bad total option length %u < 4]", opts_len);
451 return;
452 }
453 ND_PRINT(" OPTS LEN %u", opts_len);
454 opts_len -= 4;
455
456 while (opts_len) {
457 if (opts_len < PGM_MIN_OPT_LEN) {
458 ND_PRINT("[Total option length leaves no room for final option]");
459 return;
460 }
461 ND_TCHECK_2(bp);
462 opt_type = GET_U_1(bp);
463 bp++;
464 opt_len = GET_U_1(bp);
465 bp++;
466 if (opt_len < PGM_MIN_OPT_LEN) {
467 ND_PRINT("[Bad option, length %u < %u]", opt_len,
468 PGM_MIN_OPT_LEN);
469 break;
470 }
471 if (opts_len < opt_len) {
472 ND_PRINT("[Total option length leaves no room for final option]");
473 return;
474 }
475 ND_TCHECK_LEN(bp, opt_len - 2);
476
477 switch (opt_type & PGM_OPT_MASK) {
478 case PGM_OPT_LENGTH:
479 #define PGM_OPT_LENGTH_LEN (2+2)
480 if (opt_len != PGM_OPT_LENGTH_LEN) {
481 ND_PRINT("[Bad OPT_LENGTH option, length %u != %u]",
482 opt_len, PGM_OPT_LENGTH_LEN);
483 return;
484 }
485 ND_PRINT(" OPTS LEN (extra?) %u", GET_BE_U_2(bp));
486 bp += 2;
487 opts_len -= PGM_OPT_LENGTH_LEN;
488 break;
489
490 case PGM_OPT_FRAGMENT:
491 #define PGM_OPT_FRAGMENT_LEN (2+2+4+4+4)
492 if (opt_len != PGM_OPT_FRAGMENT_LEN) {
493 ND_PRINT("[Bad OPT_FRAGMENT option, length %u != %u]",
494 opt_len, PGM_OPT_FRAGMENT_LEN);
495 return;
496 }
497 bp += 2;
498 seq = GET_BE_U_4(bp);
499 bp += 4;
500 offset = GET_BE_U_4(bp);
501 bp += 4;
502 len = GET_BE_U_4(bp);
503 bp += 4;
504 ND_PRINT(" FRAG seq %u off %u len %u", seq, offset, len);
505 opts_len -= PGM_OPT_FRAGMENT_LEN;
506 break;
507
508 case PGM_OPT_NAK_LIST:
509 bp += 2;
510 opt_len -= 4; /* option header */
511 ND_PRINT(" NAK LIST");
512 while (opt_len) {
513 if (opt_len < 4) {
514 ND_PRINT("[Option length not a multiple of 4]");
515 return;
516 }
517 ND_PRINT(" %u", GET_BE_U_4(bp));
518 bp += 4;
519 opt_len -= 4;
520 opts_len -= 4;
521 }
522 break;
523
524 case PGM_OPT_JOIN:
525 #define PGM_OPT_JOIN_LEN (2+2+4)
526 if (opt_len != PGM_OPT_JOIN_LEN) {
527 ND_PRINT("[Bad OPT_JOIN option, length %u != %u]",
528 opt_len, PGM_OPT_JOIN_LEN);
529 return;
530 }
531 bp += 2;
532 seq = GET_BE_U_4(bp);
533 bp += 4;
534 ND_PRINT(" JOIN %u", seq);
535 opts_len -= PGM_OPT_JOIN_LEN;
536 break;
537
538 case PGM_OPT_NAK_BO_IVL:
539 #define PGM_OPT_NAK_BO_IVL_LEN (2+2+4+4)
540 if (opt_len != PGM_OPT_NAK_BO_IVL_LEN) {
541 ND_PRINT("[Bad OPT_NAK_BO_IVL option, length %u != %u]",
542 opt_len, PGM_OPT_NAK_BO_IVL_LEN);
543 return;
544 }
545 bp += 2;
546 offset = GET_BE_U_4(bp);
547 bp += 4;
548 seq = GET_BE_U_4(bp);
549 bp += 4;
550 ND_PRINT(" BACKOFF ivl %u ivlseq %u", offset, seq);
551 opts_len -= PGM_OPT_NAK_BO_IVL_LEN;
552 break;
553
554 case PGM_OPT_NAK_BO_RNG:
555 #define PGM_OPT_NAK_BO_RNG_LEN (2+2+4+4)
556 if (opt_len != PGM_OPT_NAK_BO_RNG_LEN) {
557 ND_PRINT("[Bad OPT_NAK_BO_RNG option, length %u != %u]",
558 opt_len, PGM_OPT_NAK_BO_RNG_LEN);
559 return;
560 }
561 bp += 2;
562 offset = GET_BE_U_4(bp);
563 bp += 4;
564 seq = GET_BE_U_4(bp);
565 bp += 4;
566 ND_PRINT(" BACKOFF max %u min %u", offset, seq);
567 opts_len -= PGM_OPT_NAK_BO_RNG_LEN;
568 break;
569
570 case PGM_OPT_REDIRECT:
571 #define PGM_OPT_REDIRECT_FIXED_LEN (2+2+2+2)
572 if (opt_len < PGM_OPT_REDIRECT_FIXED_LEN) {
573 ND_PRINT("[Bad OPT_REDIRECT option, length %u < %u]",
574 opt_len, PGM_OPT_REDIRECT_FIXED_LEN);
575 return;
576 }
577 bp += 2;
578 nla_afnum = GET_BE_U_2(bp);
579 bp += 2+2;
580 switch (nla_afnum) {
581 case AFNUM_INET:
582 if (opt_len != PGM_OPT_REDIRECT_FIXED_LEN + sizeof(nd_ipv4)) {
583 ND_PRINT("[Bad OPT_REDIRECT option, length %u != %u + address size]",
584 opt_len, PGM_OPT_REDIRECT_FIXED_LEN);
585 return;
586 }
587 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
588 addrtostr(bp, nla_buf, sizeof(nla_buf));
589 bp += sizeof(nd_ipv4);
590 opts_len -= PGM_OPT_REDIRECT_FIXED_LEN + sizeof(nd_ipv4);
591 break;
592 case AFNUM_INET6:
593 if (opt_len != PGM_OPT_REDIRECT_FIXED_LEN + sizeof(nd_ipv6)) {
594 ND_PRINT("[Bad OPT_REDIRECT option, length %u != %u + address size]",
595 opt_len, PGM_OPT_REDIRECT_FIXED_LEN);
596 return;
597 }
598 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
599 addrtostr6(bp, nla_buf, sizeof(nla_buf));
600 bp += sizeof(nd_ipv6);
601 opts_len -= PGM_OPT_REDIRECT_FIXED_LEN + sizeof(nd_ipv6);
602 break;
603 default:
604 goto trunc;
605 break;
606 }
607
608 ND_PRINT(" REDIRECT %s", nla_buf);
609 break;
610
611 case PGM_OPT_PARITY_PRM:
612 #define PGM_OPT_PARITY_PRM_LEN (2+2+4)
613 if (opt_len != PGM_OPT_PARITY_PRM_LEN) {
614 ND_PRINT("[Bad OPT_PARITY_PRM option, length %u != %u]",
615 opt_len, PGM_OPT_PARITY_PRM_LEN);
616 return;
617 }
618 bp += 2;
619 len = GET_BE_U_4(bp);
620 bp += 4;
621 ND_PRINT(" PARITY MAXTGS %u", len);
622 opts_len -= PGM_OPT_PARITY_PRM_LEN;
623 break;
624
625 case PGM_OPT_PARITY_GRP:
626 #define PGM_OPT_PARITY_GRP_LEN (2+2+4)
627 if (opt_len != PGM_OPT_PARITY_GRP_LEN) {
628 ND_PRINT("[Bad OPT_PARITY_GRP option, length %u != %u]",
629 opt_len, PGM_OPT_PARITY_GRP_LEN);
630 return;
631 }
632 bp += 2;
633 seq = GET_BE_U_4(bp);
634 bp += 4;
635 ND_PRINT(" PARITY GROUP %u", seq);
636 opts_len -= PGM_OPT_PARITY_GRP_LEN;
637 break;
638
639 case PGM_OPT_CURR_TGSIZE:
640 #define PGM_OPT_CURR_TGSIZE_LEN (2+2+4)
641 if (opt_len != PGM_OPT_CURR_TGSIZE_LEN) {
642 ND_PRINT("[Bad OPT_CURR_TGSIZE option, length %u != %u]",
643 opt_len, PGM_OPT_CURR_TGSIZE_LEN);
644 return;
645 }
646 bp += 2;
647 len = GET_BE_U_4(bp);
648 bp += 4;
649 ND_PRINT(" PARITY ATGS %u", len);
650 opts_len -= PGM_OPT_CURR_TGSIZE_LEN;
651 break;
652
653 case PGM_OPT_NBR_UNREACH:
654 #define PGM_OPT_NBR_UNREACH_LEN (2+2)
655 if (opt_len != PGM_OPT_NBR_UNREACH_LEN) {
656 ND_PRINT("[Bad OPT_NBR_UNREACH option, length %u != %u]",
657 opt_len, PGM_OPT_NBR_UNREACH_LEN);
658 return;
659 }
660 bp += 2;
661 ND_PRINT(" NBR_UNREACH");
662 opts_len -= PGM_OPT_NBR_UNREACH_LEN;
663 break;
664
665 case PGM_OPT_PATH_NLA:
666 ND_PRINT(" PATH_NLA [%u]", opt_len);
667 bp += opt_len;
668 opts_len -= opt_len;
669 break;
670
671 case PGM_OPT_SYN:
672 #define PGM_OPT_SYN_LEN (2+2)
673 if (opt_len != PGM_OPT_SYN_LEN) {
674 ND_PRINT("[Bad OPT_SYN option, length %u != %u]",
675 opt_len, PGM_OPT_SYN_LEN);
676 return;
677 }
678 bp += 2;
679 ND_PRINT(" SYN");
680 opts_len -= PGM_OPT_SYN_LEN;
681 break;
682
683 case PGM_OPT_FIN:
684 #define PGM_OPT_FIN_LEN (2+2)
685 if (opt_len != PGM_OPT_FIN_LEN) {
686 ND_PRINT("[Bad OPT_FIN option, length %u != %u]",
687 opt_len, PGM_OPT_FIN_LEN);
688 return;
689 }
690 bp += 2;
691 ND_PRINT(" FIN");
692 opts_len -= PGM_OPT_FIN_LEN;
693 break;
694
695 case PGM_OPT_RST:
696 #define PGM_OPT_RST_LEN (2+2)
697 if (opt_len != PGM_OPT_RST_LEN) {
698 ND_PRINT("[Bad OPT_RST option, length %u != %u]",
699 opt_len, PGM_OPT_RST_LEN);
700 return;
701 }
702 bp += 2;
703 ND_PRINT(" RST");
704 opts_len -= PGM_OPT_RST_LEN;
705 break;
706
707 case PGM_OPT_CR:
708 ND_PRINT(" CR");
709 bp += opt_len;
710 opts_len -= opt_len;
711 break;
712
713 case PGM_OPT_CRQST:
714 #define PGM_OPT_CRQST_LEN (2+2)
715 if (opt_len != PGM_OPT_CRQST_LEN) {
716 ND_PRINT("[Bad OPT_CRQST option, length %u != %u]",
717 opt_len, PGM_OPT_CRQST_LEN);
718 return;
719 }
720 bp += 2;
721 ND_PRINT(" CRQST");
722 opts_len -= PGM_OPT_CRQST_LEN;
723 break;
724
725 case PGM_OPT_PGMCC_DATA:
726 #define PGM_OPT_PGMCC_DATA_FIXED_LEN (2+2+4+2+2)
727 if (opt_len < PGM_OPT_PGMCC_DATA_FIXED_LEN) {
728 ND_PRINT("[Bad OPT_PGMCC_DATA option, length %u < %u]",
729 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN);
730 return;
731 }
732 bp += 2;
733 offset = GET_BE_U_4(bp);
734 bp += 4;
735 nla_afnum = GET_BE_U_2(bp);
736 bp += 2+2;
737 switch (nla_afnum) {
738 case AFNUM_INET:
739 if (opt_len != PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(nd_ipv4)) {
740 ND_PRINT("[Bad OPT_PGMCC_DATA option, length %u != %u + address size]",
741 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN);
742 return;
743 }
744 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
745 addrtostr(bp, nla_buf, sizeof(nla_buf));
746 bp += sizeof(nd_ipv4);
747 opts_len -= PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(nd_ipv4);
748 break;
749 case AFNUM_INET6:
750 if (opt_len != PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(nd_ipv6)) {
751 ND_PRINT("[Bad OPT_PGMCC_DATA option, length %u != %u + address size]",
752 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN);
753 return;
754 }
755 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
756 addrtostr6(bp, nla_buf, sizeof(nla_buf));
757 bp += sizeof(nd_ipv6);
758 opts_len -= PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(nd_ipv6);
759 break;
760 default:
761 goto trunc;
762 break;
763 }
764
765 ND_PRINT(" PGMCC DATA %u %s", offset, nla_buf);
766 break;
767
768 case PGM_OPT_PGMCC_FEEDBACK:
769 #define PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN (2+2+4+2+2)
770 if (opt_len < PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN) {
771 ND_PRINT("[Bad PGM_OPT_PGMCC_FEEDBACK option, length %u < %u]",
772 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN);
773 return;
774 }
775 bp += 2;
776 offset = GET_BE_U_4(bp);
777 bp += 4;
778 nla_afnum = GET_BE_U_2(bp);
779 bp += 2+2;
780 switch (nla_afnum) {
781 case AFNUM_INET:
782 if (opt_len != PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(nd_ipv4)) {
783 ND_PRINT("[Bad OPT_PGMCC_FEEDBACK option, length %u != %u + address size]",
784 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN);
785 return;
786 }
787 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
788 addrtostr(bp, nla_buf, sizeof(nla_buf));
789 bp += sizeof(nd_ipv4);
790 opts_len -= PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(nd_ipv4);
791 break;
792 case AFNUM_INET6:
793 if (opt_len != PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(nd_ipv6)) {
794 ND_PRINT("[Bad OPT_PGMCC_FEEDBACK option, length %u != %u + address size]",
795 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN);
796 return;
797 }
798 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
799 addrtostr6(bp, nla_buf, sizeof(nla_buf));
800 bp += sizeof(nd_ipv6);
801 opts_len -= PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(nd_ipv6);
802 break;
803 default:
804 goto trunc;
805 break;
806 }
807
808 ND_PRINT(" PGMCC FEEDBACK %u %s", offset, nla_buf);
809 break;
810
811 default:
812 ND_PRINT(" OPT_%02X [%u] ", opt_type, opt_len);
813 bp += opt_len;
814 opts_len -= opt_len;
815 break;
816 }
817
818 if (opt_type & PGM_OPT_END)
819 break;
820 }
821 }
822
823 ND_PRINT(" [%u]", length);
824 if (ndo->ndo_packettype == PT_PGM_ZMTP1 &&
825 (pgm_type_val == PGM_ODATA || pgm_type_val == PGM_RDATA))
826 zmtp1_datagram_print(ndo, bp,
827 GET_BE_U_2(pgm->pgm_length));
828
829 return;
830
831 trunc:
832 nd_print_trunc(ndo);
833 }