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