]> The Tcpdump Group git mirrors - tcpdump/blob - print-pgm.c
remove redundant ND_TCHECK, let GET_ routines handle checks
[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 opt_type = GET_U_1(bp);
462 bp++;
463 opt_len = GET_U_1(bp);
464 bp++;
465 if (opt_len < PGM_MIN_OPT_LEN) {
466 ND_PRINT("[Bad option, length %u < %u]", opt_len,
467 PGM_MIN_OPT_LEN);
468 break;
469 }
470 if (opts_len < opt_len) {
471 ND_PRINT("[Total option length leaves no room for final option]");
472 return;
473 }
474 ND_TCHECK_LEN(bp, opt_len - 2);
475
476 switch (opt_type & PGM_OPT_MASK) {
477 case PGM_OPT_LENGTH:
478 #define PGM_OPT_LENGTH_LEN (2+2)
479 if (opt_len != PGM_OPT_LENGTH_LEN) {
480 ND_PRINT("[Bad OPT_LENGTH option, length %u != %u]",
481 opt_len, PGM_OPT_LENGTH_LEN);
482 return;
483 }
484 ND_PRINT(" OPTS LEN (extra?) %u", GET_BE_U_2(bp));
485 bp += 2;
486 opts_len -= PGM_OPT_LENGTH_LEN;
487 break;
488
489 case PGM_OPT_FRAGMENT:
490 #define PGM_OPT_FRAGMENT_LEN (2+2+4+4+4)
491 if (opt_len != PGM_OPT_FRAGMENT_LEN) {
492 ND_PRINT("[Bad OPT_FRAGMENT option, length %u != %u]",
493 opt_len, PGM_OPT_FRAGMENT_LEN);
494 return;
495 }
496 bp += 2;
497 seq = GET_BE_U_4(bp);
498 bp += 4;
499 offset = GET_BE_U_4(bp);
500 bp += 4;
501 len = GET_BE_U_4(bp);
502 bp += 4;
503 ND_PRINT(" FRAG seq %u off %u len %u", seq, offset, len);
504 opts_len -= PGM_OPT_FRAGMENT_LEN;
505 break;
506
507 case PGM_OPT_NAK_LIST:
508 bp += 2;
509 opt_len -= 4; /* option header */
510 ND_PRINT(" NAK LIST");
511 while (opt_len) {
512 if (opt_len < 4) {
513 ND_PRINT("[Option length not a multiple of 4]");
514 return;
515 }
516 ND_PRINT(" %u", GET_BE_U_4(bp));
517 bp += 4;
518 opt_len -= 4;
519 opts_len -= 4;
520 }
521 break;
522
523 case PGM_OPT_JOIN:
524 #define PGM_OPT_JOIN_LEN (2+2+4)
525 if (opt_len != PGM_OPT_JOIN_LEN) {
526 ND_PRINT("[Bad OPT_JOIN option, length %u != %u]",
527 opt_len, PGM_OPT_JOIN_LEN);
528 return;
529 }
530 bp += 2;
531 seq = GET_BE_U_4(bp);
532 bp += 4;
533 ND_PRINT(" JOIN %u", seq);
534 opts_len -= PGM_OPT_JOIN_LEN;
535 break;
536
537 case PGM_OPT_NAK_BO_IVL:
538 #define PGM_OPT_NAK_BO_IVL_LEN (2+2+4+4)
539 if (opt_len != PGM_OPT_NAK_BO_IVL_LEN) {
540 ND_PRINT("[Bad OPT_NAK_BO_IVL option, length %u != %u]",
541 opt_len, PGM_OPT_NAK_BO_IVL_LEN);
542 return;
543 }
544 bp += 2;
545 offset = GET_BE_U_4(bp);
546 bp += 4;
547 seq = GET_BE_U_4(bp);
548 bp += 4;
549 ND_PRINT(" BACKOFF ivl %u ivlseq %u", offset, seq);
550 opts_len -= PGM_OPT_NAK_BO_IVL_LEN;
551 break;
552
553 case PGM_OPT_NAK_BO_RNG:
554 #define PGM_OPT_NAK_BO_RNG_LEN (2+2+4+4)
555 if (opt_len != PGM_OPT_NAK_BO_RNG_LEN) {
556 ND_PRINT("[Bad OPT_NAK_BO_RNG option, length %u != %u]",
557 opt_len, PGM_OPT_NAK_BO_RNG_LEN);
558 return;
559 }
560 bp += 2;
561 offset = GET_BE_U_4(bp);
562 bp += 4;
563 seq = GET_BE_U_4(bp);
564 bp += 4;
565 ND_PRINT(" BACKOFF max %u min %u", offset, seq);
566 opts_len -= PGM_OPT_NAK_BO_RNG_LEN;
567 break;
568
569 case PGM_OPT_REDIRECT:
570 #define PGM_OPT_REDIRECT_FIXED_LEN (2+2+2+2)
571 if (opt_len < PGM_OPT_REDIRECT_FIXED_LEN) {
572 ND_PRINT("[Bad OPT_REDIRECT option, length %u < %u]",
573 opt_len, PGM_OPT_REDIRECT_FIXED_LEN);
574 return;
575 }
576 bp += 2;
577 nla_afnum = GET_BE_U_2(bp);
578 bp += 2+2;
579 switch (nla_afnum) {
580 case AFNUM_INET:
581 if (opt_len != PGM_OPT_REDIRECT_FIXED_LEN + sizeof(nd_ipv4)) {
582 ND_PRINT("[Bad OPT_REDIRECT option, length %u != %u + address size]",
583 opt_len, PGM_OPT_REDIRECT_FIXED_LEN);
584 return;
585 }
586 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
587 addrtostr(bp, nla_buf, sizeof(nla_buf));
588 bp += sizeof(nd_ipv4);
589 opts_len -= PGM_OPT_REDIRECT_FIXED_LEN + sizeof(nd_ipv4);
590 break;
591 case AFNUM_INET6:
592 if (opt_len != PGM_OPT_REDIRECT_FIXED_LEN + sizeof(nd_ipv6)) {
593 ND_PRINT("[Bad OPT_REDIRECT option, length %u != %u + address size]",
594 opt_len, PGM_OPT_REDIRECT_FIXED_LEN);
595 return;
596 }
597 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
598 addrtostr6(bp, nla_buf, sizeof(nla_buf));
599 bp += sizeof(nd_ipv6);
600 opts_len -= PGM_OPT_REDIRECT_FIXED_LEN + sizeof(nd_ipv6);
601 break;
602 default:
603 goto trunc;
604 break;
605 }
606
607 ND_PRINT(" REDIRECT %s", nla_buf);
608 break;
609
610 case PGM_OPT_PARITY_PRM:
611 #define PGM_OPT_PARITY_PRM_LEN (2+2+4)
612 if (opt_len != PGM_OPT_PARITY_PRM_LEN) {
613 ND_PRINT("[Bad OPT_PARITY_PRM option, length %u != %u]",
614 opt_len, PGM_OPT_PARITY_PRM_LEN);
615 return;
616 }
617 bp += 2;
618 len = GET_BE_U_4(bp);
619 bp += 4;
620 ND_PRINT(" PARITY MAXTGS %u", len);
621 opts_len -= PGM_OPT_PARITY_PRM_LEN;
622 break;
623
624 case PGM_OPT_PARITY_GRP:
625 #define PGM_OPT_PARITY_GRP_LEN (2+2+4)
626 if (opt_len != PGM_OPT_PARITY_GRP_LEN) {
627 ND_PRINT("[Bad OPT_PARITY_GRP option, length %u != %u]",
628 opt_len, PGM_OPT_PARITY_GRP_LEN);
629 return;
630 }
631 bp += 2;
632 seq = GET_BE_U_4(bp);
633 bp += 4;
634 ND_PRINT(" PARITY GROUP %u", seq);
635 opts_len -= PGM_OPT_PARITY_GRP_LEN;
636 break;
637
638 case PGM_OPT_CURR_TGSIZE:
639 #define PGM_OPT_CURR_TGSIZE_LEN (2+2+4)
640 if (opt_len != PGM_OPT_CURR_TGSIZE_LEN) {
641 ND_PRINT("[Bad OPT_CURR_TGSIZE option, length %u != %u]",
642 opt_len, PGM_OPT_CURR_TGSIZE_LEN);
643 return;
644 }
645 bp += 2;
646 len = GET_BE_U_4(bp);
647 bp += 4;
648 ND_PRINT(" PARITY ATGS %u", len);
649 opts_len -= PGM_OPT_CURR_TGSIZE_LEN;
650 break;
651
652 case PGM_OPT_NBR_UNREACH:
653 #define PGM_OPT_NBR_UNREACH_LEN (2+2)
654 if (opt_len != PGM_OPT_NBR_UNREACH_LEN) {
655 ND_PRINT("[Bad OPT_NBR_UNREACH option, length %u != %u]",
656 opt_len, PGM_OPT_NBR_UNREACH_LEN);
657 return;
658 }
659 bp += 2;
660 ND_PRINT(" NBR_UNREACH");
661 opts_len -= PGM_OPT_NBR_UNREACH_LEN;
662 break;
663
664 case PGM_OPT_PATH_NLA:
665 ND_PRINT(" PATH_NLA [%u]", opt_len);
666 bp += opt_len;
667 opts_len -= opt_len;
668 break;
669
670 case PGM_OPT_SYN:
671 #define PGM_OPT_SYN_LEN (2+2)
672 if (opt_len != PGM_OPT_SYN_LEN) {
673 ND_PRINT("[Bad OPT_SYN option, length %u != %u]",
674 opt_len, PGM_OPT_SYN_LEN);
675 return;
676 }
677 bp += 2;
678 ND_PRINT(" SYN");
679 opts_len -= PGM_OPT_SYN_LEN;
680 break;
681
682 case PGM_OPT_FIN:
683 #define PGM_OPT_FIN_LEN (2+2)
684 if (opt_len != PGM_OPT_FIN_LEN) {
685 ND_PRINT("[Bad OPT_FIN option, length %u != %u]",
686 opt_len, PGM_OPT_FIN_LEN);
687 return;
688 }
689 bp += 2;
690 ND_PRINT(" FIN");
691 opts_len -= PGM_OPT_FIN_LEN;
692 break;
693
694 case PGM_OPT_RST:
695 #define PGM_OPT_RST_LEN (2+2)
696 if (opt_len != PGM_OPT_RST_LEN) {
697 ND_PRINT("[Bad OPT_RST option, length %u != %u]",
698 opt_len, PGM_OPT_RST_LEN);
699 return;
700 }
701 bp += 2;
702 ND_PRINT(" RST");
703 opts_len -= PGM_OPT_RST_LEN;
704 break;
705
706 case PGM_OPT_CR:
707 ND_PRINT(" CR");
708 bp += opt_len;
709 opts_len -= opt_len;
710 break;
711
712 case PGM_OPT_CRQST:
713 #define PGM_OPT_CRQST_LEN (2+2)
714 if (opt_len != PGM_OPT_CRQST_LEN) {
715 ND_PRINT("[Bad OPT_CRQST option, length %u != %u]",
716 opt_len, PGM_OPT_CRQST_LEN);
717 return;
718 }
719 bp += 2;
720 ND_PRINT(" CRQST");
721 opts_len -= PGM_OPT_CRQST_LEN;
722 break;
723
724 case PGM_OPT_PGMCC_DATA:
725 #define PGM_OPT_PGMCC_DATA_FIXED_LEN (2+2+4+2+2)
726 if (opt_len < PGM_OPT_PGMCC_DATA_FIXED_LEN) {
727 ND_PRINT("[Bad OPT_PGMCC_DATA option, length %u < %u]",
728 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN);
729 return;
730 }
731 bp += 2;
732 offset = GET_BE_U_4(bp);
733 bp += 4;
734 nla_afnum = GET_BE_U_2(bp);
735 bp += 2+2;
736 switch (nla_afnum) {
737 case AFNUM_INET:
738 if (opt_len != PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(nd_ipv4)) {
739 ND_PRINT("[Bad OPT_PGMCC_DATA option, length %u != %u + address size]",
740 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN);
741 return;
742 }
743 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
744 addrtostr(bp, nla_buf, sizeof(nla_buf));
745 bp += sizeof(nd_ipv4);
746 opts_len -= PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(nd_ipv4);
747 break;
748 case AFNUM_INET6:
749 if (opt_len != PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(nd_ipv6)) {
750 ND_PRINT("[Bad OPT_PGMCC_DATA option, length %u != %u + address size]",
751 opt_len, PGM_OPT_PGMCC_DATA_FIXED_LEN);
752 return;
753 }
754 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
755 addrtostr6(bp, nla_buf, sizeof(nla_buf));
756 bp += sizeof(nd_ipv6);
757 opts_len -= PGM_OPT_PGMCC_DATA_FIXED_LEN + sizeof(nd_ipv6);
758 break;
759 default:
760 goto trunc;
761 break;
762 }
763
764 ND_PRINT(" PGMCC DATA %u %s", offset, nla_buf);
765 break;
766
767 case PGM_OPT_PGMCC_FEEDBACK:
768 #define PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN (2+2+4+2+2)
769 if (opt_len < PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN) {
770 ND_PRINT("[Bad PGM_OPT_PGMCC_FEEDBACK option, length %u < %u]",
771 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN);
772 return;
773 }
774 bp += 2;
775 offset = GET_BE_U_4(bp);
776 bp += 4;
777 nla_afnum = GET_BE_U_2(bp);
778 bp += 2+2;
779 switch (nla_afnum) {
780 case AFNUM_INET:
781 if (opt_len != PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(nd_ipv4)) {
782 ND_PRINT("[Bad OPT_PGMCC_FEEDBACK option, length %u != %u + address size]",
783 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN);
784 return;
785 }
786 ND_TCHECK_LEN(bp, sizeof(nd_ipv4));
787 addrtostr(bp, nla_buf, sizeof(nla_buf));
788 bp += sizeof(nd_ipv4);
789 opts_len -= PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(nd_ipv4);
790 break;
791 case AFNUM_INET6:
792 if (opt_len != PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(nd_ipv6)) {
793 ND_PRINT("[Bad OPT_PGMCC_FEEDBACK option, length %u != %u + address size]",
794 opt_len, PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN);
795 return;
796 }
797 ND_TCHECK_LEN(bp, sizeof(nd_ipv6));
798 addrtostr6(bp, nla_buf, sizeof(nla_buf));
799 bp += sizeof(nd_ipv6);
800 opts_len -= PGM_OPT_PGMCC_FEEDBACK_FIXED_LEN + sizeof(nd_ipv6);
801 break;
802 default:
803 goto trunc;
804 break;
805 }
806
807 ND_PRINT(" PGMCC FEEDBACK %u %s", offset, nla_buf);
808 break;
809
810 default:
811 ND_PRINT(" OPT_%02X [%u] ", opt_type, opt_len);
812 bp += opt_len;
813 opts_len -= opt_len;
814 break;
815 }
816
817 if (opt_type & PGM_OPT_END)
818 break;
819 }
820 }
821
822 ND_PRINT(" [%u]", length);
823 if (ndo->ndo_packettype == PT_PGM_ZMTP1 &&
824 (pgm_type_val == PGM_ODATA || pgm_type_val == PGM_RDATA))
825 zmtp1_datagram_print(ndo, bp,
826 GET_BE_U_2(pgm->pgm_length));
827
828 return;
829
830 trunc:
831 nd_print_trunc(ndo);
832 }