2 * netsniff-ng - the packet sniffing beast
3 * Copyright 2012, 2013 Tobias Klauser <tklauser@distanz.ch>
4 * Subject to the GPL, version 2.
8 #include <arpa/inet.h> /* for inet_ntop() */
9 #include <netinet/in.h> /* for ntohs()/ntohl() */
17 #define EXTRACT_16BIT(x) ntohs(*((uint16_t *) (x)))
18 #define EXTRACT_32BIT(x) ntohl(*((uint32_t *) (x)))
20 #define LLDP_TLV_TYPE(tlv) (((tlv) & 0xFE00) >> 9)
21 #define LLDP_TLV_LENGTH(tlv) ((tlv) & 0x01FF)
26 #define LLDP_TLV_END 0
27 #define LLDP_TLV_CHASSIS_ID 1
28 #define LLDP_TLV_PORT_ID 2
29 #define LLDP_TLV_TTL 3
30 #define LLDP_TLV_PORT_DESC 4
31 #define LLDP_TLV_SYSTEM_NAME 5
32 #define LLDP_TLV_SYSTEM_DESC 6
33 #define LLDP_TLV_SYSTEM_CAP 7
34 #define LLDP_TLV_MGMT_ADDR 8
35 #define LLDP_TLV_ORG_SPECIFIC 127
40 #define LLDP_CHASSIS_SUBTYPE_CHASSIS 1
41 #define LLDP_CHASSIS_SUBTYPE_IF_ALIAS 2
42 #define LLDP_CHASSIS_SUBTYPE_PORT 3
43 #define LLDP_CHASSIS_SUBTYPE_MAC_ADDR 4
44 #define LLDP_CHASSIS_SUBTYPE_NET_ADDR 5
45 #define LLDP_CHASSIS_SUBTYPE_IF_NAME 6
46 #define LLDP_CHASSIS_SUBTYPE_LOCAL 7
51 #define LLDP_PORT_SUBTYPE_IF_ALIAS 1
52 #define LLDP_PORT_SUBTYPE_PORT_COMP 2
53 #define LLDP_PORT_SUBTYPE_MAC_ADDR 3
54 #define LLDP_PORT_SUBTYPE_NET_ADDR 4
55 #define LLDP_PORT_SUBTYPE_IF_NAME 5
56 #define LLDP_PORT_SUBTYPE_AGENT_CIRC_ID 6
57 #define LLDP_PORT_SUBTYPE_LOCAL 7
60 * System capabilits bit masks
62 #define LLDP_SYSTEM_CAP_OTHER (1 << 0)
63 #define LLDP_SYSTEM_CAP_REPEATER (1 << 1)
64 #define LLDP_SYSTEM_CAP_BRIDGE (1 << 2)
65 #define LLDP_SYSTEM_CAP_WLAN_AP (1 << 3)
66 #define LLDP_SYSTEM_CAP_ROUTER (1 << 4)
67 #define LLDP_SYSTEM_CAP_TELEPHONE (1 << 5)
68 #define LLDP_SYSTEM_CAP_DOCSIS (1 << 6)
69 #define LLDP_SYSTEM_CAP_STATION_ONLY (1 << 7)
72 * Interface number subtypes (for Management addres TLV)
74 #define LLDP_IFACE_NUM_SUBTYPE_UNKNOWN 1
75 #define LLDP_IFACE_NUM_SUBTYPE_IF_INDEX 2
76 #define LLDP_IFACE_NUM_SUBTYPE_SYS_PORT 3
79 * IANA address family numbers (only the ones we actually use)
80 * http://www.iana.org/assignments/address-family-numbers/address-family-numbers.txt
82 * TODO: Move these into own header if there are other users?
84 #define IANA_AF_IPV4 1
85 #define IANA_AF_IPV6 2
88 static int lldp_print_net_addr(const uint8_t *addr
, size_t addrlen
)
102 inet_ntop(AF_INET
, addr
, buf
, sizeof(buf
));
108 inet_ntop(AF_INET6
, addr
, buf
, sizeof(buf
));
114 tprintf("%.2x:%.2x:%.2x:%.2x:%.2x:%.2x",
115 addr
[0], addr
[1], addr
[2], addr
[3], addr
[4], addr
[5]);
118 tprintf("unknown address family");
125 static void lldp_print_cap(uint16_t cap
)
127 unsigned int prev
= 0;
129 if (cap
& LLDP_SYSTEM_CAP_OTHER
)
130 tprintf("%sOther", prev
++ ? ", " : "");
131 if (cap
& LLDP_SYSTEM_CAP_REPEATER
)
132 tprintf("%sRepeater", prev
++ ? ", " : "");
133 if (cap
& LLDP_SYSTEM_CAP_BRIDGE
)
134 tprintf("%sBridge", prev
++ ? ", " : "");
135 if (cap
& LLDP_SYSTEM_CAP_WLAN_AP
)
136 tprintf("%sWLAN AP", prev
++ ? ", " : "");
137 if (cap
& LLDP_SYSTEM_CAP_ROUTER
)
138 tprintf("%sRouter", prev
++ ? ", " : "");
139 if (cap
& LLDP_SYSTEM_CAP_TELEPHONE
)
140 tprintf("%sTelephone", prev
++ ? ", " : "");
141 if (cap
& LLDP_SYSTEM_CAP_DOCSIS
)
142 tprintf("%sDOCSIS", prev
++ ? ", " : "");
143 if (cap
& LLDP_SYSTEM_CAP_STATION_ONLY
)
144 tprintf("%sStation only", prev
++ ? ", " : "");
147 static void lldp(struct pkt_buff
*pkt
)
149 unsigned int n_tlv
= 0;
150 uint8_t subtype
, mgmt_alen
, mgmt_oidlen
;
152 unsigned int tlv_type
, tlv_len
;
154 uint8_t *tlv_info_str
;
155 uint16_t sys_cap
, en_cap
;
164 while (len
>= sizeof(tlv_hdr
)) {
165 uint8_t *data
= pkt_pull(pkt
, sizeof(tlv_hdr
));
169 tlv_hdr
= EXTRACT_16BIT(data
);
170 tlv_type
= LLDP_TLV_TYPE(tlv_hdr
);
171 tlv_len
= LLDP_TLV_LENGTH(tlv_hdr
);
173 len
-= sizeof(tlv_hdr
);
175 if (tlv_type
== LLDP_TLV_END
&& tlv_len
== 0) {
176 /* Chassis ID, Port ID and TTL are mandatory */
186 case LLDP_TLV_CHASSIS_ID
:
188 * The mandatory chassis ID shall be the first TLV and
189 * shall appear exactly once.
194 tprintf("Chassis ID");
199 tlv_info_str
= pkt_pull(pkt
, tlv_len
);
200 if (tlv_info_str
== NULL
)
203 subtype
= *tlv_info_str
++;
204 tprintf(" (Subtype %u => ", subtype
);
207 case LLDP_CHASSIS_SUBTYPE_MAC_ADDR
:
211 tprintf("%.2x:%.2x:%.2x:%.2x:%.2x:%.2x",
212 tlv_info_str
[0], tlv_info_str
[1],
213 tlv_info_str
[2], tlv_info_str
[3],
214 tlv_info_str
[4], tlv_info_str
[5]);
216 case LLDP_CHASSIS_SUBTYPE_NET_ADDR
:
217 if (lldp_print_net_addr(tlv_info_str
, tlv_len
))
220 case LLDP_CHASSIS_SUBTYPE_CHASSIS
:
221 case LLDP_CHASSIS_SUBTYPE_IF_ALIAS
:
222 case LLDP_CHASSIS_SUBTYPE_PORT
:
223 case LLDP_CHASSIS_SUBTYPE_IF_NAME
:
224 case LLDP_CHASSIS_SUBTYPE_LOCAL
:
225 tputs_safe((const char *) tlv_info_str
, tlv_len
- 1);
234 case LLDP_TLV_PORT_ID
:
236 * The mandatory port ID shall be the second TLV and
237 * shall appear exactly once.
242 tprintf(", Port ID");
247 tlv_info_str
= pkt_pull(pkt
, tlv_len
);
248 if (tlv_info_str
== NULL
)
251 subtype
= *tlv_info_str
++;
252 tprintf(" (Subtype %u => ", subtype
);
255 case LLDP_PORT_SUBTYPE_MAC_ADDR
:
259 tprintf("%.2x:%.2x:%.2x:%.2x:%.2x:%.2x",
260 tlv_info_str
[0], tlv_info_str
[1],
261 tlv_info_str
[2], tlv_info_str
[3],
262 tlv_info_str
[4], tlv_info_str
[5]);
264 case LLDP_PORT_SUBTYPE_NET_ADDR
:
265 if (lldp_print_net_addr(tlv_info_str
, tlv_len
))
268 case LLDP_PORT_SUBTYPE_IF_ALIAS
:
269 case LLDP_PORT_SUBTYPE_PORT_COMP
:
270 case LLDP_PORT_SUBTYPE_IF_NAME
:
271 case LLDP_PORT_SUBTYPE_AGENT_CIRC_ID
:
272 case LLDP_PORT_SUBTYPE_LOCAL
:
273 tputs_safe((const char *) tlv_info_str
, tlv_len
- 1);
284 * The mandatory TTL shall be the third TLV and
285 * shall appear exactly once.
295 tlv_info_str
= pkt_pull(pkt
, tlv_len
);
296 if (tlv_info_str
== NULL
)
299 tprintf(" (%u)", EXTRACT_16BIT(tlv_info_str
));
301 case LLDP_TLV_PORT_DESC
:
302 tprintf(", Port desc (");
304 tlv_info_str
= pkt_pull(pkt
, tlv_len
);
305 if (tlv_info_str
== NULL
)
308 tputs_safe((const char *) tlv_info_str
, tlv_len
);
312 case LLDP_TLV_SYSTEM_NAME
:
313 tprintf(", Sys name (");
315 tlv_info_str
= pkt_pull(pkt
, tlv_len
);
316 if (tlv_info_str
== NULL
)
319 tputs_safe((const char *) tlv_info_str
, tlv_len
);
323 case LLDP_TLV_SYSTEM_DESC
:
324 tprintf(", Sys desc (");
326 tlv_info_str
= pkt_pull(pkt
, tlv_len
);
327 if (tlv_info_str
== NULL
)
330 tputs_safe((const char *) tlv_info_str
, tlv_len
);
334 case LLDP_TLV_SYSTEM_CAP
:
335 tprintf(", Sys Cap");
340 tlv_info_str
= pkt_pull(pkt
, tlv_len
);
341 if (tlv_info_str
== NULL
)
344 sys_cap
= EXTRACT_16BIT(tlv_info_str
);
345 tlv_info_str
+= sizeof(uint32_t);
346 en_cap
= EXTRACT_16BIT(tlv_info_str
);
349 lldp_print_cap(sys_cap
);
351 tprintf(" Ena Cap (");
352 lldp_print_cap(en_cap
);
355 case LLDP_TLV_MGMT_ADDR
:
356 tprintf(", Mgmt Addr (");
358 if (tlv_len
< 9 || tlv_len
> 167)
361 tlv_info_str
= pkt_pull(pkt
, tlv_len
);
362 if (tlv_info_str
== NULL
)
365 mgmt_alen
= *tlv_info_str
;
367 if (tlv_len
- 1 < mgmt_alen
)
370 if (lldp_print_net_addr(tlv_info_str
, mgmt_alen
))
372 tlv_info_str
+= mgmt_alen
;
374 tprintf(", Iface Subtype %d/", *tlv_info_str
);
375 switch (*tlv_info_str
) {
376 case LLDP_IFACE_NUM_SUBTYPE_IF_INDEX
:
379 case LLDP_IFACE_NUM_SUBTYPE_SYS_PORT
:
380 tprintf("System Port Number");
388 tprintf(", Iface Number %u", EXTRACT_32BIT(tlv_info_str
));
391 mgmt_oidlen
= *tlv_info_str
;
392 if (tlv_len
- mgmt_alen
- sizeof(uint32_t) - 3 < mgmt_oidlen
)
394 if (mgmt_oidlen
> 0) {
396 tputs_safe((const char *) tlv_info_str
+ 1, mgmt_oidlen
);
401 case LLDP_TLV_ORG_SPECIFIC
:
402 tprintf(", Org specific");
407 tlv_info_str
= pkt_pull(pkt
, 4);
408 if (tlv_info_str
== NULL
)
411 oui
= ntohl(*((uint32_t *) tlv_info_str
));
412 subtype
= oui
& 0xff;
414 tprintf(" (OUI %s, Subtype %u)", lookup_vendor_str(oui
),
417 /* Just eat it up, we don't know how to interpret it */
418 pkt_pull(pkt
, tlv_len
- 4);
421 tprintf(", Unknown TLV %u", tlv_type
);
422 pkt_pull(pkt
, tlv_len
);
435 tprintf(" %sINVALID%s ]\n", colorize_start_full(black
, red
),
439 static void lldp_less(struct pkt_buff
*pkt
)
441 unsigned int len
, n_tlv
= 0;
442 unsigned int tlv_type
, tlv_len
;
447 while (len
>= sizeof(tlv_hdr
)) {
448 uint8_t *data
= pkt_pull(pkt
, sizeof(tlv_hdr
));
452 tlv_hdr
= EXTRACT_16BIT(data
);
453 tlv_type
= LLDP_TLV_TYPE(tlv_hdr
);
454 tlv_len
= LLDP_TLV_LENGTH(tlv_hdr
);
457 len
-= sizeof(tlv_hdr
);
459 if (tlv_type
== LLDP_TLV_END
|| tlv_len
== 0)
464 pkt_pull(pkt
, tlv_len
);
469 tprintf(" %u TLV%s", n_tlv
, n_tlv
== 1 ? "" : "s");
472 struct protocol lldp_ops
= {
475 .print_less
= lldp_less
,