xref: /freebsd/contrib/tcpdump/print-lspping.c (revision 0a7e5f1f02aad2ff5fff1c60f44c6975fd07e1d9)
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 Hannes Gredler (hannes@gredler.at)
14  */
15 
16 /* \summary: MPLS LSP PING printer */
17 
18 /* specification: RFC 4379 */
19 
20 #include <config.h>
21 
22 #include "netdissect-stdinc.h"
23 
24 #define ND_LONGJMP_FROM_TCHECK
25 #include "netdissect.h"
26 #include "extract.h"
27 #include "addrtoname.h"
28 #include "ntp.h"
29 
30 #include "l2vpn.h"
31 #include "oui.h"
32 
33 
34 /*
35  * LSPPING common header
36  *
37  *  0                   1                   2                   3
38  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
39  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
40  * |         Version Number        |         Must Be Zero          |
41  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
42  * |  Message Type |   Reply mode  |  Return Code  | Return Subcode|
43  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
44  * |                        Sender's Handle                        |
45  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
46  * |                        Sequence Number                        |
47  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
48  * |                    TimeStamp Sent (seconds)                   |
49  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
50  * |                  TimeStamp Sent (microseconds)                |
51  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
52  * |                  TimeStamp Received (seconds)                 |
53  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
54  * |                TimeStamp Received (microseconds)              |
55  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
56  * |                            TLVs ...                           |
57  * .                                                               .
58  * .                                                               .
59  * .                                                               .
60  */
61 
62 struct lspping_common_header {
63     nd_uint16_t version;
64     nd_uint16_t global_flags;
65     nd_uint8_t  msg_type;
66     nd_uint8_t  reply_mode;
67     nd_uint8_t  return_code;
68     nd_uint8_t  return_subcode;
69     nd_uint32_t sender_handle;
70     nd_uint32_t seq_number;
71     struct l_fixedpt ts_sent;
72     struct l_fixedpt ts_rcvd;
73 };
74 
75 #define LSPPING_VERSION            1
76 
77 static const struct tok lspping_msg_type_values[] = {
78     { 1, "MPLS Echo Request"},
79     { 2, "MPLS Echo Reply"},
80     { 0, NULL}
81 };
82 
83 static const struct tok lspping_reply_mode_values[] = {
84     { 1, "Do not reply"},
85     { 2, "Reply via an IPv4/IPv6 UDP packet"},
86     { 3, "Reply via an IPv4/IPv6 UDP packet with Router Alert"},
87     { 4, "Reply via application level control channel"},
88     { 0, NULL}
89 };
90 
91 static const struct tok lspping_return_code_values[] = {
92     {  0, "No return code or return code contained in the Error Code TLV"},
93     {  1, "Malformed echo request received"},
94     {  2, "One or more of the TLVs was not understood"},
95     {  3, "Replying router is an egress for the FEC at stack depth"},
96     {  4, "Replying router has no mapping for the FEC at stack depth"},
97     {  5, "Reserved"},
98     {  6, "Reserved"},
99     {  7, "Reserved"},
100     {  8, "Label switched at stack-depth"},
101     {  9, "Label switched but no MPLS forwarding at stack-depth"},
102     { 10, "Mapping for this FEC is not the given label at stack depth"},
103     { 11, "No label entry at stack-depth"},
104     { 12, "Protocol not associated with interface at FEC stack depth"},
105     { 13, "Premature termination of ping due to label stack shrinking to a single label"},
106     { 0,  NULL},
107 };
108 
109 
110 /*
111  * LSPPING TLV header
112  *  0                   1                   2                   3
113  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
114  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
115  * |             Type              |            Length             |
116  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
117  * |                             Value                             |
118  * .                                                               .
119  * .                                                               .
120  * .                                                               .
121  * |                                                               |
122  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
123  */
124 
125 struct lspping_tlv_header {
126     nd_uint16_t type;
127     nd_uint16_t length;
128 };
129 
130 #define	LSPPING_TLV_TARGET_FEC_STACK      1
131 #define	LSPPING_TLV_DOWNSTREAM_MAPPING    2
132 #define	LSPPING_TLV_PAD                   3
133 /* not assigned                           4 */
134 #define LSPPING_TLV_VENDOR_ENTERPRISE     5
135 #define LSPPING_TLV_VENDOR_ENTERPRISE_LEN 4
136 /* not assigned                           6 */
137 #define LSPPING_TLV_INTERFACE_LABEL_STACK 7
138 /* not assigned                           8 */
139 #define	LSPPING_TLV_ERROR_CODE            9
140 #define LSPPING_TLV_REPLY_TOS_BYTE        10
141 #define	LSPPING_TLV_BFD_DISCRIMINATOR     15 /* draft-ietf-bfd-mpls-02 */
142 #define LSPPING_TLV_BFD_DISCRIMINATOR_LEN 4
143 #define	LSPPING_TLV_VENDOR_PRIVATE        0xfc00
144 
145 static const struct tok lspping_tlv_values[] = {
146     { LSPPING_TLV_TARGET_FEC_STACK, "Target FEC Stack" },
147     { LSPPING_TLV_DOWNSTREAM_MAPPING, "Downstream Mapping" },
148     { LSPPING_TLV_PAD, "Pad" },
149     { LSPPING_TLV_ERROR_CODE, "Error Code" },
150     { LSPPING_TLV_VENDOR_ENTERPRISE, "Vendor Enterprise Code" },
151     { LSPPING_TLV_INTERFACE_LABEL_STACK, "Interface Label Stack" },
152     { LSPPING_TLV_REPLY_TOS_BYTE, "Reply TOS Byte" },
153     { LSPPING_TLV_BFD_DISCRIMINATOR, "BFD Discriminator" },
154     { LSPPING_TLV_VENDOR_PRIVATE, "Vendor Private Code" },
155     { 0, NULL}
156 };
157 
158 #define	LSPPING_TLV_TARGETFEC_SUBTLV_LDP_IPV4       1
159 #define	LSPPING_TLV_TARGETFEC_SUBTLV_LDP_IPV6       2
160 #define	LSPPING_TLV_TARGETFEC_SUBTLV_RSVP_IPV4      3
161 #define	LSPPING_TLV_TARGETFEC_SUBTLV_RSVP_IPV6      4
162 /* not assigned                                     5 */
163 #define	LSPPING_TLV_TARGETFEC_SUBTLV_L3VPN_IPV4     6
164 #define	LSPPING_TLV_TARGETFEC_SUBTLV_L3VPN_IPV6     7
165 #define	LSPPING_TLV_TARGETFEC_SUBTLV_L2VPN_ENDPT    8
166 #define	LSPPING_TLV_TARGETFEC_SUBTLV_FEC_128_PW_OLD 9
167 #define	LSPPING_TLV_TARGETFEC_SUBTLV_FEC_128_PW     10
168 #define	LSPPING_TLV_TARGETFEC_SUBTLV_FEC_129_PW     11
169 #define	LSPPING_TLV_TARGETFEC_SUBTLV_BGP_IPV4       12
170 #define	LSPPING_TLV_TARGETFEC_SUBTLV_BGP_IPV6       13
171 #define	LSPPING_TLV_TARGETFEC_SUBTLV_GENERIC_IPV4   14
172 #define	LSPPING_TLV_TARGETFEC_SUBTLV_GENERIC_IPV6   15
173 #define	LSPPING_TLV_TARGETFEC_SUBTLV_NIL_FEC        16
174 
175 static const struct tok lspping_tlvtargetfec_subtlv_values[] = {
176     { LSPPING_TLV_TARGETFEC_SUBTLV_LDP_IPV4, "LDP IPv4 prefix"},
177     { LSPPING_TLV_TARGETFEC_SUBTLV_LDP_IPV6, "LDP IPv6 prefix"},
178     { LSPPING_TLV_TARGETFEC_SUBTLV_RSVP_IPV4, "RSVP IPv4 Session Query"},
179     { LSPPING_TLV_TARGETFEC_SUBTLV_RSVP_IPV6, "RSVP IPv6 Session Query"},
180     { 5, "Reserved"},
181     { LSPPING_TLV_TARGETFEC_SUBTLV_L3VPN_IPV4, "VPN IPv4 prefix"},
182     { LSPPING_TLV_TARGETFEC_SUBTLV_L3VPN_IPV6, "VPN IPv6 prefix"},
183     { LSPPING_TLV_TARGETFEC_SUBTLV_L2VPN_ENDPT, "L2 VPN endpoint"},
184     { LSPPING_TLV_TARGETFEC_SUBTLV_FEC_128_PW_OLD, "FEC 128 pseudowire (old)"},
185     { LSPPING_TLV_TARGETFEC_SUBTLV_FEC_128_PW, "FEC 128 pseudowire"},
186     { LSPPING_TLV_TARGETFEC_SUBTLV_BGP_IPV4, "BGP labeled IPv4 prefix"},
187     { LSPPING_TLV_TARGETFEC_SUBTLV_BGP_IPV6, "BGP labeled IPv6 prefix"},
188     { 0, NULL}
189 };
190 
191 /*
192  *  0                   1                   2                   3
193  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
194  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
195  * |                          IPv4 prefix                          |
196  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
197  * | Prefix Length |         Must Be Zero                          |
198  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
199  */
200 struct lspping_tlv_targetfec_subtlv_ldp_ipv4_t {
201     nd_ipv4    prefix;
202     nd_uint8_t prefix_len;
203 };
204 
205 /*
206  *  0                   1                   2                   3
207  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
208  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
209  * |                          IPv6 prefix                          |
210  * |                          (16 octets)                          |
211  * |                                                               |
212  * |                                                               |
213  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
214  * | Prefix Length |         Must Be Zero                          |
215  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
216  */
217 struct lspping_tlv_targetfec_subtlv_ldp_ipv6_t {
218     nd_ipv6    prefix;
219     nd_uint8_t prefix_len;
220 };
221 
222 /*
223  *  0                   1                   2                   3
224  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
225  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
226  * |                 IPv4 tunnel end point address                 |
227  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
228  * |          Must Be Zero         |     Tunnel ID                 |
229  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
230  * |                       Extended Tunnel ID                      |
231  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
232  * |                   IPv4 tunnel sender address                  |
233  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
234  * |          Must Be Zero         |            LSP ID             |
235  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
236  */
237 struct lspping_tlv_targetfec_subtlv_rsvp_ipv4_t {
238     nd_ipv4     tunnel_endpoint;
239     nd_byte     res[2];
240     nd_uint16_t tunnel_id;
241     nd_ipv4     extended_tunnel_id;
242     nd_ipv4     tunnel_sender;
243     nd_byte     res2[2];
244     nd_uint16_t lsp_id;
245 };
246 
247 /*
248  *  0                   1                   2                   3
249  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
250  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
251  * |                 IPv6 tunnel end point address                 |
252  * |                                                               |
253  * |                                                               |
254  * |                                                               |
255  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
256  * |          Must Be Zero         |          Tunnel ID            |
257  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
258  * |                       Extended Tunnel ID                      |
259  * |                                                               |
260  * |                                                               |
261  * |                                                               |
262  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
263  * |                   IPv6 tunnel sender address                  |
264  * |                                                               |
265  * |                                                               |
266  * |                                                               |
267  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
268  * |          Must Be Zero         |            LSP ID             |
269  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
270  */
271 struct lspping_tlv_targetfec_subtlv_rsvp_ipv6_t {
272     nd_ipv6     tunnel_endpoint;
273     nd_byte     res[2];
274     nd_uint16_t tunnel_id;
275     nd_ipv6     extended_tunnel_id;
276     nd_ipv6     tunnel_sender;
277     nd_byte     res2[2];
278     nd_uint16_t lsp_id;
279 };
280 
281 /*
282  *  0                   1                   2                   3
283  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
284  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
285  * |                      Route Distinguisher                      |
286  * |                          (8 octets)                           |
287  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
288  * |                         IPv4 prefix                           |
289  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
290  * | Prefix Length |                 Must Be Zero                  |
291  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
292  */
293 struct lspping_tlv_targetfec_subtlv_l3vpn_ipv4_t {
294     nd_byte    rd[8];
295     nd_ipv4    prefix;
296     nd_uint8_t prefix_len;
297 };
298 
299 /*
300  *  0                   1                   2                   3
301  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
302  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
303  * |                      Route Distinguisher                      |
304  * |                          (8 octets)                           |
305  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
306  * |                          IPv6 prefix                          |
307  * |                          (16 octets)                          |
308  * |                                                               |
309  * |                                                               |
310  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
311  * | Prefix Length |                 Must Be Zero                  |
312  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
313  */
314 struct lspping_tlv_targetfec_subtlv_l3vpn_ipv6_t {
315     nd_byte    rd[8];
316     nd_ipv6    prefix;
317     nd_uint8_t prefix_len;
318 };
319 
320 /*
321  *  0                   1                   2                   3
322  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
323  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
324  * |                      Route Distinguisher                      |
325  * |                          (8 octets)                           |
326  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
327  * |         Sender's VE ID        |       Receiver's VE ID        |
328  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
329  * |      Encapsulation Type       |         Must Be Zero          |
330  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
331  *  0                   1                   2                   3
332  */
333 struct lspping_tlv_targetfec_subtlv_l2vpn_endpt_t {
334     nd_byte     rd[8];
335     nd_uint16_t sender_ve_id;
336     nd_uint16_t receiver_ve_id;
337     nd_uint16_t encapsulation;
338 };
339 
340 /*
341  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
342  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
343  * |                      Remote PE Address                        |
344  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
345  * |                             PW ID                             |
346  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
347  * |            PW Type            |          Must Be Zero         |
348  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
349  */
350 struct lspping_tlv_targetfec_subtlv_fec_128_pw_old {
351     nd_ipv4     remote_pe_address;
352     nd_uint32_t pw_id;
353     nd_uint16_t pw_type;
354 };
355 
356 /*
357  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
358  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
359  * |                     Sender's PE Address                       |
360  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
361  * |                      Remote PE Address                        |
362  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
363  * |                             PW ID                             |
364  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
365  * |            PW Type            |          Must Be Zero         |
366  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
367  */
368 struct lspping_tlv_targetfec_subtlv_fec_128_pw {
369     nd_ipv4     sender_pe_address;
370     nd_ipv4     remote_pe_address;
371     nd_uint32_t pw_id;
372     nd_uint16_t pw_type;
373 };
374 
375 /*
376  * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
377  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
378  * |                         IPv4 prefix                           |
379  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
380  * | Prefix Length |                 Must Be Zero                  |
381  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
382  */
383 struct lspping_tlv_targetfec_subtlv_bgp_ipv4_t {
384     nd_ipv4    prefix;
385     nd_uint8_t prefix_len;
386 };
387 
388 /*
389  * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
390  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
391  * |                          IPv6 prefix                          |
392  * |                          (16 octets)                          |
393  * |                                                               |
394  * |                                                               |
395  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
396  * | Prefix Length |                 Must Be Zero                  |
397  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
398  */
399 struct lspping_tlv_targetfec_subtlv_bgp_ipv6_t {
400     nd_ipv6    prefix;
401     nd_uint8_t prefix_len;
402 };
403 
404 /*
405  *  0                   1                   2                   3
406  *  0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
407  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
408  * |               MTU             | Address Type  |  Resvd (SBZ)  |
409  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
410  * |             Downstream IP Address (4 or 16 octets)            |
411  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
412  * |         Downstream Interface Address (4 or 16 octets)         |
413  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
414  * | Multipath Type| Depth Limit   |        Multipath Length       |
415  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
416  * .                                                               .
417  * .                     (Multipath Information)                   .
418  * .                                                               .
419  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
420  * |               Downstream Label                |    Protocol   |
421  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
422  * .                                                               .
423  * .                                                               .
424  * .                                                               .
425  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
426  * |               Downstream Label                |    Protocol   |
427  * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
428  */
429 /* Enough to get the address type */
430 struct lspping_tlv_downstream_map_t {
431     nd_uint16_t mtu;
432     nd_uint8_t  address_type;
433     nd_uint8_t  ds_flags;
434 };
435 
436 struct lspping_tlv_downstream_map_ipv4_t {
437     nd_uint16_t mtu;
438     nd_uint8_t  address_type;
439     nd_uint8_t  ds_flags;
440     nd_ipv4     downstream_ip;
441     nd_ipv4     downstream_interface;
442 };
443 
444 struct lspping_tlv_downstream_map_ipv4_unmb_t {
445     nd_uint16_t mtu;
446     nd_uint8_t  address_type;
447     nd_uint8_t  ds_flags;
448     nd_ipv4     downstream_ip;
449     nd_uint32_t downstream_interface;
450 };
451 
452 struct lspping_tlv_downstream_map_ipv6_t {
453     nd_uint16_t mtu;
454     nd_uint8_t  address_type;
455     nd_uint8_t  ds_flags;
456     nd_ipv6     downstream_ip;
457     nd_ipv6     downstream_interface;
458 };
459 
460 struct lspping_tlv_downstream_map_ipv6_unmb_t {
461     nd_uint16_t mtu;
462     nd_uint8_t  address_type;
463     nd_uint8_t  ds_flags;
464     nd_ipv6     downstream_ip;
465     nd_uint32_t downstream_interface;
466 };
467 
468 struct lspping_tlv_downstream_map_info_t {
469     nd_uint8_t  multipath_type;
470     nd_uint8_t  depth_limit;
471     nd_uint16_t multipath_length;
472 };
473 
474 #define LSPPING_AFI_IPV4      1
475 #define LSPPING_AFI_IPV4_UNMB 2
476 #define LSPPING_AFI_IPV6      3
477 #define LSPPING_AFI_IPV6_UNMB 4
478 
479 static const struct tok lspping_tlv_downstream_addr_values[] = {
480     { LSPPING_AFI_IPV4,      "IPv4"},
481     { LSPPING_AFI_IPV4_UNMB, "Unnumbered IPv4"},
482     { LSPPING_AFI_IPV6,      "IPv6"},
483     { LSPPING_AFI_IPV6_UNMB, "IPv6"},
484     { 0, NULL}
485 };
486 
487 void
lspping_print(netdissect_options * ndo,const u_char * pptr,u_int len)488 lspping_print(netdissect_options *ndo,
489               const u_char *pptr, u_int len)
490 {
491     const struct lspping_common_header *lspping_com_header;
492     const struct lspping_tlv_header *lspping_tlv_header;
493     const struct lspping_tlv_header *lspping_subtlv_header;
494     const u_char *tptr,*tlv_tptr,*subtlv_tptr;
495     u_int return_code, return_subcode;
496     u_int tlen,lspping_tlv_len,lspping_tlv_type,tlv_tlen;
497     int tlv_hexdump,subtlv_hexdump;
498     u_int lspping_subtlv_len,lspping_subtlv_type;
499     uint32_t int_part, fraction;
500     u_int address_type;
501 
502     union {
503         const struct lspping_tlv_downstream_map_t *lspping_tlv_downstream_map;
504         const struct lspping_tlv_downstream_map_ipv4_t *lspping_tlv_downstream_map_ipv4;
505         const struct lspping_tlv_downstream_map_ipv4_unmb_t *lspping_tlv_downstream_map_ipv4_unmb;
506         const struct lspping_tlv_downstream_map_ipv6_t *lspping_tlv_downstream_map_ipv6;
507         const struct lspping_tlv_downstream_map_ipv6_unmb_t *lspping_tlv_downstream_map_ipv6_unmb;
508         const struct lspping_tlv_downstream_map_info_t  *lspping_tlv_downstream_map_info;
509     } tlv_ptr;
510 
511     union {
512         const struct lspping_tlv_targetfec_subtlv_ldp_ipv4_t *lspping_tlv_targetfec_subtlv_ldp_ipv4;
513         const struct lspping_tlv_targetfec_subtlv_ldp_ipv6_t *lspping_tlv_targetfec_subtlv_ldp_ipv6;
514         const struct lspping_tlv_targetfec_subtlv_rsvp_ipv4_t *lspping_tlv_targetfec_subtlv_rsvp_ipv4;
515         const struct lspping_tlv_targetfec_subtlv_rsvp_ipv6_t *lspping_tlv_targetfec_subtlv_rsvp_ipv6;
516         const struct lspping_tlv_targetfec_subtlv_l3vpn_ipv4_t *lspping_tlv_targetfec_subtlv_l3vpn_ipv4;
517         const struct lspping_tlv_targetfec_subtlv_l3vpn_ipv6_t *lspping_tlv_targetfec_subtlv_l3vpn_ipv6;
518         const struct lspping_tlv_targetfec_subtlv_l2vpn_endpt_t *lspping_tlv_targetfec_subtlv_l2vpn_endpt;
519         const struct lspping_tlv_targetfec_subtlv_fec_128_pw_old *lspping_tlv_targetfec_subtlv_l2vpn_vcid_old;
520         const struct lspping_tlv_targetfec_subtlv_fec_128_pw *lspping_tlv_targetfec_subtlv_l2vpn_vcid;
521         const struct lspping_tlv_targetfec_subtlv_bgp_ipv4_t *lspping_tlv_targetfec_subtlv_bgp_ipv4;
522         const struct lspping_tlv_targetfec_subtlv_bgp_ipv6_t *lspping_tlv_targetfec_subtlv_bgp_ipv6;
523     } subtlv_ptr;
524 
525     ndo->ndo_protocol = "lspping";
526     tptr=pptr;
527     lspping_com_header = (const struct lspping_common_header *)pptr;
528     if (len < sizeof(struct lspping_common_header))
529         goto tooshort;
530     ND_TCHECK_SIZE(lspping_com_header);
531 
532     /*
533      * Sanity checking of the header.
534      */
535     if (GET_BE_U_2(lspping_com_header->version) != LSPPING_VERSION) {
536 	ND_PRINT("LSP-PING version %u packet not supported",
537                GET_BE_U_2(lspping_com_header->version));
538 	return;
539     }
540 
541     /* in non-verbose mode just lets print the basic Message Type*/
542     if (ndo->ndo_vflag < 1) {
543         ND_PRINT("LSP-PINGv%u, %s, seq %u, length: %u",
544                GET_BE_U_2(lspping_com_header->version),
545                tok2str(lspping_msg_type_values, "unknown (%u)",GET_U_1(lspping_com_header->msg_type)),
546                GET_BE_U_4(lspping_com_header->seq_number),
547                len);
548         return;
549     }
550 
551     /* ok they seem to want to know everything - lets fully decode it */
552 
553     tlen=len;
554 
555     ND_PRINT("\n\tLSP-PINGv%u, msg-type: %s (%u), length: %u\n\t  reply-mode: %s (%u)",
556            GET_BE_U_2(lspping_com_header->version),
557            tok2str(lspping_msg_type_values, "unknown",GET_U_1(lspping_com_header->msg_type)),
558            GET_U_1(lspping_com_header->msg_type),
559            len,
560            tok2str(lspping_reply_mode_values, "unknown",GET_U_1(lspping_com_header->reply_mode)),
561            GET_U_1(lspping_com_header->reply_mode));
562 
563     /*
564      *  the following return codes require that the subcode is attached
565      *  at the end of the translated token output
566      */
567     return_code = GET_U_1(lspping_com_header->return_code);
568     return_subcode = GET_U_1(lspping_com_header->return_subcode);
569     if (return_code == 3 ||
570         return_code == 4 ||
571         return_code == 8 ||
572         return_code == 10 ||
573         return_code == 11 ||
574         return_code == 12 )
575         ND_PRINT("\n\t  Return Code: %s %u (%u)\n\t  Return Subcode: (%u)",
576                tok2str(lspping_return_code_values, "unknown",return_code),
577                return_subcode,
578                return_code,
579                return_subcode);
580     else
581         ND_PRINT("\n\t  Return Code: %s (%u)\n\t  Return Subcode: (%u)",
582                tok2str(lspping_return_code_values, "unknown",return_code),
583                return_code,
584                return_subcode);
585 
586     ND_PRINT("\n\t  Sender Handle: 0x%08x, Sequence: %u",
587            GET_BE_U_4(lspping_com_header->sender_handle),
588            GET_BE_U_4(lspping_com_header->seq_number));
589 
590     ND_PRINT("\n\t  Sender Timestamp: ");
591     p_ntp_time(ndo, &lspping_com_header->ts_sent);
592     ND_PRINT(" ");
593 
594     int_part=GET_BE_U_4(lspping_com_header->ts_rcvd.int_part);
595     fraction=GET_BE_U_4(lspping_com_header->ts_rcvd.fraction);
596     ND_PRINT("Receiver Timestamp: ");
597     if (! (int_part == 0 && fraction == 0))
598         p_ntp_time(ndo, &lspping_com_header->ts_rcvd);
599     else
600         ND_PRINT("no timestamp");
601 
602     tptr+=sizeof(struct lspping_common_header);
603     tlen-=sizeof(struct lspping_common_header);
604 
605     while (tlen != 0) {
606         /* Does the TLV go past the end of the packet? */
607         if (tlen < sizeof(struct lspping_tlv_header))
608             goto tooshort;
609 
610         lspping_tlv_header = (const struct lspping_tlv_header *)tptr;
611         lspping_tlv_type=GET_BE_U_2(lspping_tlv_header->type);
612         lspping_tlv_len=GET_BE_U_2(lspping_tlv_header->length);
613 
614         ND_PRINT("\n\t  %s TLV (%u), length: %u",
615                tok2str(lspping_tlv_values,
616                        "Unknown",
617                        lspping_tlv_type),
618                lspping_tlv_type,
619                lspping_tlv_len);
620 
621         /* some little sanity checking */
622         if (lspping_tlv_len == 0) {
623             tptr+=sizeof(struct lspping_tlv_header);
624             tlen-=sizeof(struct lspping_tlv_header);
625             continue;    /* no value to dissect */
626         }
627 
628         tlv_tptr=tptr+sizeof(struct lspping_tlv_header);
629         tlv_tlen=lspping_tlv_len; /* header not included -> no adjustment */
630 
631         /* Does the TLV go past the end of the packet? */
632         if (tlen < lspping_tlv_len+sizeof(struct lspping_tlv_header))
633             goto tooshort;
634         /* did we capture enough for fully decoding the tlv ? */
635         ND_TCHECK_LEN(tlv_tptr, lspping_tlv_len);
636         tlv_hexdump=FALSE;
637 
638         switch(lspping_tlv_type) {
639         case LSPPING_TLV_TARGET_FEC_STACK:
640             while (tlv_tlen != 0) {
641                 /* Does the subTLV header go past the end of the TLV? */
642                 if (tlv_tlen < sizeof(struct lspping_tlv_header)) {
643                     ND_PRINT("\n\t      TLV is too short");
644                     tlv_hexdump = TRUE;
645                     goto tlv_tooshort;
646                 }
647                 subtlv_hexdump=FALSE;
648 
649                 lspping_subtlv_header = (const struct lspping_tlv_header *)tlv_tptr;
650                 lspping_subtlv_type=GET_BE_U_2(lspping_subtlv_header->type);
651                 lspping_subtlv_len=GET_BE_U_2(lspping_subtlv_header->length);
652                 subtlv_tptr=tlv_tptr+sizeof(struct lspping_tlv_header);
653 
654                 /* Does the subTLV go past the end of the TLV? */
655                 if (tlv_tlen < lspping_subtlv_len+sizeof(struct lspping_tlv_header)) {
656                     ND_PRINT("\n\t      TLV is too short");
657                     tlv_hexdump = TRUE;
658                     goto tlv_tooshort;
659                 }
660 
661                 /* Did we capture enough for fully decoding the subTLV? */
662                 ND_TCHECK_LEN(subtlv_tptr, lspping_subtlv_len);
663 
664                 ND_PRINT("\n\t    %s subTLV (%u), length: %u",
665                        tok2str(lspping_tlvtargetfec_subtlv_values,
666                                "Unknown",
667                                lspping_subtlv_type),
668                        lspping_subtlv_type,
669                        lspping_subtlv_len);
670 
671                 switch(lspping_subtlv_type) {
672 
673                 case LSPPING_TLV_TARGETFEC_SUBTLV_LDP_IPV4:
674                     /* Is the subTLV length correct? */
675                     if (lspping_subtlv_len != 5) {
676                         ND_PRINT("\n\t      invalid subTLV length, should be 5");
677                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
678                     } else {
679                         subtlv_ptr.lspping_tlv_targetfec_subtlv_ldp_ipv4 =
680                             (const struct lspping_tlv_targetfec_subtlv_ldp_ipv4_t *)subtlv_tptr;
681                         ND_PRINT("\n\t      %s/%u",
682                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_ldp_ipv4->prefix),
683                                GET_U_1(subtlv_ptr.lspping_tlv_targetfec_subtlv_ldp_ipv4->prefix_len));
684                     }
685                     break;
686 
687                 case LSPPING_TLV_TARGETFEC_SUBTLV_LDP_IPV6:
688                     /* Is the subTLV length correct? */
689                     if (lspping_subtlv_len != 17) {
690                         ND_PRINT("\n\t      invalid subTLV length, should be 17");
691                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
692                     } else {
693                         subtlv_ptr.lspping_tlv_targetfec_subtlv_ldp_ipv6 =
694                             (const struct lspping_tlv_targetfec_subtlv_ldp_ipv6_t *)subtlv_tptr;
695                         ND_PRINT("\n\t      %s/%u",
696                                GET_IP6ADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_ldp_ipv6->prefix),
697                                GET_U_1(subtlv_ptr.lspping_tlv_targetfec_subtlv_ldp_ipv6->prefix_len));
698                     }
699                     break;
700 
701                 case LSPPING_TLV_TARGETFEC_SUBTLV_BGP_IPV4:
702                     /* Is the subTLV length correct? */
703                     if (lspping_subtlv_len != 5) {
704                         ND_PRINT("\n\t      invalid subTLV length, should be 5");
705                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
706                     } else {
707                         subtlv_ptr.lspping_tlv_targetfec_subtlv_bgp_ipv4 =
708                             (const struct lspping_tlv_targetfec_subtlv_bgp_ipv4_t *)subtlv_tptr;
709                         ND_PRINT("\n\t      %s/%u",
710                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_bgp_ipv4->prefix),
711                                GET_U_1(subtlv_ptr.lspping_tlv_targetfec_subtlv_bgp_ipv4->prefix_len));
712                     }
713                     break;
714 
715                 case LSPPING_TLV_TARGETFEC_SUBTLV_BGP_IPV6:
716                     /* Is the subTLV length correct? */
717                     if (lspping_subtlv_len != 17) {
718                         ND_PRINT("\n\t      invalid subTLV length, should be 17");
719                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
720                     } else {
721                         subtlv_ptr.lspping_tlv_targetfec_subtlv_bgp_ipv6 =
722                             (const struct lspping_tlv_targetfec_subtlv_bgp_ipv6_t *)subtlv_tptr;
723                         ND_PRINT("\n\t      %s/%u",
724                                GET_IP6ADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_bgp_ipv6->prefix),
725                                GET_U_1(subtlv_ptr.lspping_tlv_targetfec_subtlv_bgp_ipv6->prefix_len));
726                     }
727                     break;
728 
729                 case LSPPING_TLV_TARGETFEC_SUBTLV_RSVP_IPV4:
730                     /* Is the subTLV length correct? */
731                     if (lspping_subtlv_len != 20) {
732                         ND_PRINT("\n\t      invalid subTLV length, should be 20");
733                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
734                     } else {
735                         subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv4 =
736                             (const struct lspping_tlv_targetfec_subtlv_rsvp_ipv4_t *)subtlv_tptr;
737                         ND_PRINT("\n\t      tunnel end-point %s, tunnel sender %s, lsp-id 0x%04x"
738                                "\n\t      tunnel-id 0x%04x, extended tunnel-id %s",
739                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv4->tunnel_endpoint),
740                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv4->tunnel_sender),
741                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv4->lsp_id),
742                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv4->tunnel_id),
743                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv4->extended_tunnel_id));
744                     }
745                     break;
746 
747                 case LSPPING_TLV_TARGETFEC_SUBTLV_RSVP_IPV6:
748                     /* Is the subTLV length correct? */
749                     if (lspping_subtlv_len != 56) {
750                         ND_PRINT("\n\t      invalid subTLV length, should be 56");
751                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
752                     } else {
753                         subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv6 =
754                             (const struct lspping_tlv_targetfec_subtlv_rsvp_ipv6_t *)subtlv_tptr;
755                         ND_PRINT("\n\t      tunnel end-point %s, tunnel sender %s, lsp-id 0x%04x"
756                                "\n\t      tunnel-id 0x%04x, extended tunnel-id %s",
757                                GET_IP6ADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv6->tunnel_endpoint),
758                                GET_IP6ADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv6->tunnel_sender),
759                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv6->lsp_id),
760                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv6->tunnel_id),
761                                GET_IP6ADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_rsvp_ipv6->extended_tunnel_id));
762                     }
763                     break;
764 
765                 case LSPPING_TLV_TARGETFEC_SUBTLV_L3VPN_IPV4:
766                     /* Is the subTLV length correct? */
767                     if (lspping_subtlv_len != 13) {
768                         ND_PRINT("\n\t      invalid subTLV length, should be 13");
769                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
770                     } else {
771                         subtlv_ptr.lspping_tlv_targetfec_subtlv_l3vpn_ipv4 =
772                             (const struct lspping_tlv_targetfec_subtlv_l3vpn_ipv4_t *)subtlv_tptr;
773                         ND_PRINT("\n\t      RD: %s, %s/%u",
774                                bgp_vpn_rd_print(ndo, subtlv_ptr.lspping_tlv_targetfec_subtlv_l3vpn_ipv4->rd),
775                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_l3vpn_ipv4->prefix),
776                                GET_U_1(subtlv_ptr.lspping_tlv_targetfec_subtlv_l3vpn_ipv4->prefix_len));
777                     }
778                     break;
779 
780                 case LSPPING_TLV_TARGETFEC_SUBTLV_L3VPN_IPV6:
781                     /* Is the subTLV length correct? */
782                     if (lspping_subtlv_len != 25) {
783                         ND_PRINT("\n\t      invalid subTLV length, should be 25");
784                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
785                     } else {
786                         subtlv_ptr.lspping_tlv_targetfec_subtlv_l3vpn_ipv6 =
787                             (const struct lspping_tlv_targetfec_subtlv_l3vpn_ipv6_t *)subtlv_tptr;
788                         ND_PRINT("\n\t      RD: %s, %s/%u",
789                                bgp_vpn_rd_print(ndo, subtlv_ptr.lspping_tlv_targetfec_subtlv_l3vpn_ipv6->rd),
790                                GET_IP6ADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_l3vpn_ipv6->prefix),
791                                GET_U_1(subtlv_ptr.lspping_tlv_targetfec_subtlv_l3vpn_ipv6->prefix_len));
792                     }
793                     break;
794 
795                 case LSPPING_TLV_TARGETFEC_SUBTLV_L2VPN_ENDPT:
796                     /* Is the subTLV length correct? */
797                     if (lspping_subtlv_len != 14) {
798                         ND_PRINT("\n\t      invalid subTLV length, should be 14");
799                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
800                     } else {
801                         subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_endpt =
802                             (const struct lspping_tlv_targetfec_subtlv_l2vpn_endpt_t *)subtlv_tptr;
803                         ND_PRINT("\n\t      RD: %s, Sender VE ID: %u, Receiver VE ID: %u"
804                                "\n\t      Encapsulation Type: %s (%u)",
805                                bgp_vpn_rd_print(ndo, subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_endpt->rd),
806                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_endpt->sender_ve_id),
807                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_endpt->receiver_ve_id),
808                                tok2str(mpls_pw_types_values,
809                                        "unknown",
810                                        GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_endpt->encapsulation)),
811                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_endpt->encapsulation));
812                     }
813                     break;
814 
815                     /* the old L2VPN VCID subTLV does not have support for the sender field */
816                 case LSPPING_TLV_TARGETFEC_SUBTLV_FEC_128_PW_OLD:
817                     /* Is the subTLV length correct? */
818                     if (lspping_subtlv_len != 10) {
819                         ND_PRINT("\n\t      invalid subTLV length, should be 10");
820                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
821                     } else {
822                         subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid_old =
823                             (const struct lspping_tlv_targetfec_subtlv_fec_128_pw_old *)subtlv_tptr;
824                         ND_PRINT("\n\t      Remote PE: %s"
825                                "\n\t      PW ID: 0x%08x, PW Type: %s (%u)",
826                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid_old->remote_pe_address),
827                                GET_BE_U_4(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid_old->pw_id),
828                                tok2str(mpls_pw_types_values,
829                                        "unknown",
830                                        GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid_old->pw_type)),
831                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid_old->pw_type));
832                     }
833                     break;
834 
835                 case LSPPING_TLV_TARGETFEC_SUBTLV_FEC_128_PW:
836                     /* Is the subTLV length correct? */
837                     if (lspping_subtlv_len != 14) {
838                         ND_PRINT("\n\t      invalid subTLV length, should be 14");
839                         subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
840                     } else {
841                         subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid =
842                             (const struct lspping_tlv_targetfec_subtlv_fec_128_pw *)subtlv_tptr;
843                         ND_PRINT("\n\t      Sender PE: %s, Remote PE: %s"
844                                "\n\t      PW ID: 0x%08x, PW Type: %s (%u)",
845                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid->sender_pe_address),
846                                GET_IPADDR_STRING(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid->remote_pe_address),
847                                GET_BE_U_4(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid->pw_id),
848                                tok2str(mpls_pw_types_values,
849                                        "unknown",
850                                        GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid->pw_type)),
851                                GET_BE_U_2(subtlv_ptr.lspping_tlv_targetfec_subtlv_l2vpn_vcid->pw_type));
852                     }
853                     break;
854 
855                 default:
856                     subtlv_hexdump=TRUE; /* unknown subTLV just hexdump it */
857                     break;
858                 }
859                 /* do we want to see an additionally subtlv hexdump ? */
860                 if (ndo->ndo_vflag > 1 || subtlv_hexdump==TRUE)
861                     print_unknown_data(ndo, tlv_tptr+sizeof(struct lspping_tlv_header),
862                                        "\n\t      ",
863                                        lspping_subtlv_len);
864 
865                 /* All subTLVs are aligned to four octet boundary */
866                 if (lspping_subtlv_len % 4) {
867                     lspping_subtlv_len += 4 - (lspping_subtlv_len % 4);
868                     /* Does the subTLV, including padding, go past the end of the TLV? */
869                     if (tlv_tlen < lspping_subtlv_len+sizeof(struct lspping_tlv_header)) {
870                         ND_PRINT("\n\t\t TLV is too short");
871                         return;
872                     }
873                 }
874                 tlv_tptr+=lspping_subtlv_len;
875                 tlv_tlen-=lspping_subtlv_len+sizeof(struct lspping_tlv_header);
876             }
877             break;
878 
879         case LSPPING_TLV_DOWNSTREAM_MAPPING:
880             /* Does the header go past the end of the TLV? */
881             if (tlv_tlen < sizeof(struct lspping_tlv_downstream_map_t)) {
882                 ND_PRINT("\n\t      TLV is too short");
883                 tlv_hexdump = TRUE;
884                 goto tlv_tooshort;
885             }
886             /* Did we capture enough to get the address family? */
887             ND_TCHECK_LEN(tlv_tptr,
888                           sizeof(struct lspping_tlv_downstream_map_t));
889 
890             tlv_ptr.lspping_tlv_downstream_map=
891                 (const struct lspping_tlv_downstream_map_t *)tlv_tptr;
892 
893             /* that strange thing with the downstream map TLV is that until now
894              * we do not know if its IPv4 or IPv6 or is unnumbered; after
895              * we find the address-type, we recast the tlv_tptr and move on. */
896 
897             address_type = GET_U_1(tlv_ptr.lspping_tlv_downstream_map->address_type);
898             ND_PRINT("\n\t    MTU: %u, Address-Type: %s (%u)",
899                    GET_BE_U_2(tlv_ptr.lspping_tlv_downstream_map->mtu),
900                    tok2str(lspping_tlv_downstream_addr_values,
901                            "unknown",
902                            address_type),
903                    address_type);
904 
905             switch(address_type) {
906 
907             case LSPPING_AFI_IPV4:
908                 /* Does the data go past the end of the TLV? */
909                 if (tlv_tlen < sizeof(struct lspping_tlv_downstream_map_ipv4_t)) {
910                     ND_PRINT("\n\t      TLV is too short");
911                     tlv_hexdump = TRUE;
912                     goto tlv_tooshort;
913                 }
914                 /* Did we capture enough for this part of the TLV? */
915                 ND_TCHECK_LEN(tlv_tptr,
916                               sizeof(struct lspping_tlv_downstream_map_ipv4_t));
917 
918                 tlv_ptr.lspping_tlv_downstream_map_ipv4=
919                     (const struct lspping_tlv_downstream_map_ipv4_t *)tlv_tptr;
920                 ND_PRINT("\n\t    Downstream IP: %s"
921                        "\n\t    Downstream Interface IP: %s",
922                        GET_IPADDR_STRING(tlv_ptr.lspping_tlv_downstream_map_ipv4->downstream_ip),
923                        GET_IPADDR_STRING(tlv_ptr.lspping_tlv_downstream_map_ipv4->downstream_interface));
924                 tlv_tptr+=sizeof(struct lspping_tlv_downstream_map_ipv4_t);
925                 tlv_tlen-=sizeof(struct lspping_tlv_downstream_map_ipv4_t);
926                 break;
927             case LSPPING_AFI_IPV4_UNMB:
928                 /* Does the data go past the end of the TLV? */
929                 if (tlv_tlen < sizeof(struct lspping_tlv_downstream_map_ipv4_unmb_t)) {
930                     ND_PRINT("\n\t      TLV is too short");
931                     tlv_hexdump = TRUE;
932                     goto tlv_tooshort;
933                 }
934                 /* Did we capture enough for this part of the TLV? */
935                 ND_TCHECK_LEN(tlv_tptr,
936                               sizeof(struct lspping_tlv_downstream_map_ipv4_unmb_t));
937 
938                 tlv_ptr.lspping_tlv_downstream_map_ipv4_unmb=
939                     (const struct lspping_tlv_downstream_map_ipv4_unmb_t *)tlv_tptr;
940                 ND_PRINT("\n\t    Downstream IP: %s"
941                        "\n\t    Downstream Interface Index: 0x%08x",
942                        GET_IPADDR_STRING(tlv_ptr.lspping_tlv_downstream_map_ipv4_unmb->downstream_ip),
943                        GET_BE_U_4(tlv_ptr.lspping_tlv_downstream_map_ipv4_unmb->downstream_interface));
944                 tlv_tptr+=sizeof(struct lspping_tlv_downstream_map_ipv4_unmb_t);
945                 tlv_tlen-=sizeof(struct lspping_tlv_downstream_map_ipv4_unmb_t);
946                 break;
947             case LSPPING_AFI_IPV6:
948                 /* Does the data go past the end of the TLV? */
949                 if (tlv_tlen < sizeof(struct lspping_tlv_downstream_map_ipv6_t)) {
950                     ND_PRINT("\n\t      TLV is too short");
951                     tlv_hexdump = TRUE;
952                     goto tlv_tooshort;
953                 }
954                 /* Did we capture enough for this part of the TLV? */
955                 ND_TCHECK_LEN(tlv_tptr,
956                               sizeof(struct lspping_tlv_downstream_map_ipv6_t));
957 
958                 tlv_ptr.lspping_tlv_downstream_map_ipv6=
959                     (const struct lspping_tlv_downstream_map_ipv6_t *)tlv_tptr;
960                 ND_PRINT("\n\t    Downstream IP: %s"
961                        "\n\t    Downstream Interface IP: %s",
962                        GET_IP6ADDR_STRING(tlv_ptr.lspping_tlv_downstream_map_ipv6->downstream_ip),
963                        GET_IP6ADDR_STRING(tlv_ptr.lspping_tlv_downstream_map_ipv6->downstream_interface));
964                 tlv_tptr+=sizeof(struct lspping_tlv_downstream_map_ipv6_t);
965                 tlv_tlen-=sizeof(struct lspping_tlv_downstream_map_ipv6_t);
966                 break;
967              case LSPPING_AFI_IPV6_UNMB:
968                 /* Does the data go past the end of the TLV? */
969                 if (tlv_tlen < sizeof(struct lspping_tlv_downstream_map_ipv6_unmb_t)) {
970                     ND_PRINT("\n\t      TLV is too short");
971                     tlv_hexdump = TRUE;
972                     goto tlv_tooshort;
973                 }
974                 /* Did we capture enough for this part of the TLV? */
975                 ND_TCHECK_LEN(tlv_tptr,
976                               sizeof(struct lspping_tlv_downstream_map_ipv6_unmb_t));
977 
978                 tlv_ptr.lspping_tlv_downstream_map_ipv6_unmb=
979                    (const struct lspping_tlv_downstream_map_ipv6_unmb_t *)tlv_tptr;
980                 ND_PRINT("\n\t    Downstream IP: %s"
981                        "\n\t    Downstream Interface Index: 0x%08x",
982                        GET_IP6ADDR_STRING(tlv_ptr.lspping_tlv_downstream_map_ipv6_unmb->downstream_ip),
983                        GET_BE_U_4(tlv_ptr.lspping_tlv_downstream_map_ipv6_unmb->downstream_interface));
984                 tlv_tptr+=sizeof(struct lspping_tlv_downstream_map_ipv6_unmb_t);
985                 tlv_tlen-=sizeof(struct lspping_tlv_downstream_map_ipv6_unmb_t);
986                 break;
987 
988             default:
989                 /* should not happen ! - no error message - tok2str() has barked already */
990                 break;
991             }
992 
993             /* Does the data go past the end of the TLV? */
994             if (tlv_tlen < sizeof(struct lspping_tlv_downstream_map_info_t)) {
995                 ND_PRINT("\n\t      TLV is too short");
996                 tlv_hexdump = TRUE;
997                 goto tlv_tooshort;
998             }
999             /* Did we capture enough for this part of the TLV? */
1000             ND_TCHECK_LEN(tlv_tptr,
1001                           sizeof(struct lspping_tlv_downstream_map_info_t));
1002 
1003             tlv_ptr.lspping_tlv_downstream_map_info=
1004                 (const struct lspping_tlv_downstream_map_info_t *)tlv_tptr;
1005 
1006             /* FIXME add hash-key type, depth limit, multipath processing */
1007 
1008             /* FIXME print downstream labels */
1009 
1010             tlv_hexdump=TRUE; /* dump the TLV until code complete */
1011 
1012             break;
1013 
1014         case LSPPING_TLV_BFD_DISCRIMINATOR:
1015             if (tlv_tlen < LSPPING_TLV_BFD_DISCRIMINATOR_LEN) {
1016                 ND_PRINT("\n\t      TLV is too short");
1017                 tlv_hexdump = TRUE;
1018                 goto tlv_tooshort;
1019             } else {
1020                 ND_PRINT("\n\t    BFD Discriminator 0x%08x", GET_BE_U_4(tlv_tptr));
1021             }
1022             break;
1023 
1024         case  LSPPING_TLV_VENDOR_ENTERPRISE:
1025         {
1026             uint32_t vendor_id;
1027 
1028             if (tlv_tlen < LSPPING_TLV_VENDOR_ENTERPRISE_LEN) {
1029                 ND_PRINT("\n\t      TLV is too short");
1030                 tlv_hexdump = TRUE;
1031                 goto tlv_tooshort;
1032             } else {
1033                 vendor_id = GET_BE_U_4(tlv_tptr);
1034                 ND_PRINT("\n\t    Vendor: %s (0x%04x)",
1035                        tok2str(smi_values, "Unknown", vendor_id),
1036                        vendor_id);
1037             }
1038         }
1039             break;
1040 
1041             /*
1042              *  FIXME those are the defined TLVs that lack a decoder
1043              *  you are welcome to contribute code ;-)
1044              */
1045         case LSPPING_TLV_PAD:
1046         case LSPPING_TLV_ERROR_CODE:
1047         case LSPPING_TLV_VENDOR_PRIVATE:
1048 
1049         default:
1050             if (ndo->ndo_vflag <= 1)
1051                 print_unknown_data(ndo, tlv_tptr, "\n\t    ", tlv_tlen);
1052             break;
1053         }
1054         /* do we want to see an additionally tlv hexdump ? */
1055     tlv_tooshort:
1056         if (ndo->ndo_vflag > 1 || tlv_hexdump==TRUE)
1057             print_unknown_data(ndo, tptr+sizeof(struct lspping_tlv_header), "\n\t    ",
1058                                lspping_tlv_len);
1059 
1060 
1061         /* All TLVs are aligned to four octet boundary */
1062         if (lspping_tlv_len % 4) {
1063             lspping_tlv_len += (4 - lspping_tlv_len % 4);
1064             /* Does the TLV, including padding, go past the end of the packet? */
1065             if (tlen < lspping_tlv_len+sizeof(struct lspping_tlv_header))
1066                 goto tooshort;
1067         }
1068 
1069         tptr+=lspping_tlv_len+sizeof(struct lspping_tlv_header);
1070         tlen-=lspping_tlv_len+sizeof(struct lspping_tlv_header);
1071     }
1072     return;
1073 tooshort:
1074     ND_PRINT("\n\t\t packet is too short");
1075 }
1076