2 * Copyright (c) 2011-2016 Cisco and/or its affiliates.
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at:
7 * http://www.apache.org/licenses/LICENSE-2.0
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
19 #define DEBUG_TLV_DUMP 0 /* 1=> dump TLV's to stdout while processing them */
22 * ported from an unspecified Cisco cdp implementation.
23 * Compute / return in HOST byte order. 0 => good checksum.
26 cdp_checksum (void *p, int count)
41 sum += *(char *) data;
45 sum = (sum & 0xFFFF) + (sum >> 16);
52 /* TLV handler table */
61 static tlv_handler_t tlv_handlers[];
63 /* Display a generic TLV as a set of hex bytes */
65 format_generic_tlv (u8 * s, va_list * va)
67 cdp_tlv_t *t = va_arg (*va, cdp_tlv_t *);
68 tlv_handler_t *h = &tlv_handlers[t->t];
70 s = format (s, "%s(%d): %U\n", h->name,
71 t->t, format_hex_bytes, t->v, t->l - sizeof (*t));
75 /* Ignore / skip a TLV we don't support */
77 process_generic_tlv (cdp_main_t * cm, cdp_neighbor_t * n, cdp_tlv_t * t)
79 #if DEBUG_TLV_DUMP > 0
80 fformat (stdout, "%U", format_generic_tlv, t);
83 return CDP_ERROR_NONE;
86 /* print a text tlv */
88 format_text_tlv (u8 * s, va_list * va)
90 cdp_tlv_t *t = va_arg (*va, cdp_tlv_t *);
91 tlv_handler_t *h = &tlv_handlers[t->t];
94 s = format (s, "%s(%d): ", h->name, t->t);
98 for (i = 0; i < (t->l - sizeof (*t)); i++)
99 vec_add1 (s, t->v[i]);
106 #if DEBUG_TLV_DUMP == 0
107 /* gcc warning be gone */
108 CLIB_UNUSED (static cdp_error_t
109 process_text_tlv (cdp_main_t * cm, cdp_neighbor_t * n,
113 /* process / skip a generic text TLV that we don't support */
115 process_text_tlv (cdp_main_t * cm, cdp_neighbor_t * n, cdp_tlv_t * t)
117 #if DEBUG_TLV_DUMP > 0
118 fformat (stdout, "%U\n", format_text_tlv, t);
121 return CDP_ERROR_NONE;
124 /* per-TLV format function definitions */
125 #define format_unused_tlv format_generic_tlv
126 #define format_device_name_tlv format_text_tlv
127 #define format_address_tlv format_generic_tlv
128 #define format_port_id_tlv format_text_tlv
129 #define format_capabilities_tlv format_generic_tlv
130 #define format_version_tlv format_text_tlv
131 #define format_platform_tlv format_text_tlv
132 #define format_ipprefix_tlv format_generic_tlv
133 #define format_hello_tlv format_generic_tlv
134 #define format_vtp_domain_tlv format_generic_tlv
135 #define format_native_vlan_tlv format_generic_tlv
136 #define format_duplex_tlv format_generic_tlv
137 #define format_appl_vlan_tlv format_generic_tlv
138 #define format_trigger_tlv format_generic_tlv
139 #define format_power_tlv format_generic_tlv
140 #define format_mtu_tlv format_generic_tlv
141 #define format_trust_tlv format_generic_tlv
142 #define format_cos_tlv format_generic_tlv
143 #define format_sysname_tlv format_generic_tlv
144 #define format_sysobject_tlv format_generic_tlv
145 #define format_mgmt_addr_tlv format_generic_tlv
146 #define format_physical_loc_tlv format_generic_tlv
147 #define format_mgmt_addr2_tlv format_generic_tlv
148 #define format_power_requested_tlv format_generic_tlv
149 #define format_power_available_tlv format_generic_tlv
150 #define format_port_unidirectional_tlv format_generic_tlv
151 #define format_unknown_28_tlv format_generic_tlv
152 #define format_energywise_tlv format_generic_tlv
153 #define format_unknown_30_tlv format_generic_tlv
154 #define format_spare_poe_tlv format_generic_tlv
156 /* tlv ID=0 is a mistake */
158 process_unused_tlv (cdp_main_t * cm, cdp_neighbor_t * n, cdp_tlv_t * t)
160 return CDP_ERROR_BAD_TLV;
163 /* list of text TLV's that we snapshoot */
164 #define foreach_text_to_struct_tlv \
165 _(device_name,DEBUG_TLV_DUMP) \
166 _(version,DEBUG_TLV_DUMP) \
167 _(platform,DEBUG_TLV_DUMP) \
168 _(port_id,DEBUG_TLV_DUMP)
171 static cdp_error_t process_##z##_tlv (cdp_main_t *cm, cdp_neighbor_t *n, \
176 fformat (stdout, "%U\n", format_text_tlv, t); \
179 vec_set_len (n->z, 0); \
181 for (i = 0; i < (t->l - sizeof (*t)); i++) \
182 vec_add1 (n->z, t->v[i]); \
184 vec_add1 (n->z, 0); \
186 return CDP_ERROR_NONE; \
189 foreach_text_to_struct_tlv
191 #define process_address_tlv process_generic_tlv
192 #define process_capabilities_tlv process_generic_tlv
193 #define process_ipprefix_tlv process_generic_tlv
194 #define process_hello_tlv process_generic_tlv
195 #define process_vtp_domain_tlv process_generic_tlv
196 #define process_native_vlan_tlv process_generic_tlv
197 #define process_duplex_tlv process_generic_tlv
198 #define process_appl_vlan_tlv process_generic_tlv
199 #define process_trigger_tlv process_generic_tlv
200 #define process_power_tlv process_generic_tlv
201 #define process_mtu_tlv process_generic_tlv
202 #define process_trust_tlv process_generic_tlv
203 #define process_cos_tlv process_generic_tlv
204 #define process_sysname_tlv process_generic_tlv
205 #define process_sysobject_tlv process_generic_tlv
206 #define process_mgmt_addr_tlv process_generic_tlv
207 #define process_physical_loc_tlv process_generic_tlv
208 #define process_mgmt_addr2_tlv process_generic_tlv
209 #define process_power_requested_tlv process_generic_tlv
210 #define process_power_available_tlv process_generic_tlv
211 #define process_port_unidirectional_tlv process_generic_tlv
212 #define process_unknown_28_tlv process_generic_tlv
213 #define process_energywise_tlv process_generic_tlv
214 #define process_unknown_30_tlv process_generic_tlv
215 #define process_spare_poe_tlv process_generic_tlv
216 static tlv_handler_t tlv_handlers[] = {
217 #define _(a) {#a, CDP_TLV_##a, format_##a##_tlv, process_##a##_tlv},
222 #if DEBUG_TLV_DUMP == 0
223 CLIB_UNUSED (static u8 * format_cdp_hdr (u8 * s, va_list * va));
227 format_cdp_hdr (u8 * s, va_list * va)
229 cdp_hdr_t *h = va_arg (*va, cdp_hdr_t *);
231 s = format (s, "version %d, ttl %d(secs), cksum 0x%04x\n",
232 h->version, h->ttl, h->checksum);
237 process_cdp_hdr (cdp_main_t * cm, cdp_neighbor_t * n, cdp_hdr_t * h)
239 #if DEBUG_TLV_DUMP > 0
240 fformat (stdout, "%U", format_cdp_hdr, h);
243 if (h->version != 1 && h->version != 2)
244 return CDP_ERROR_PROTOCOL_VERSION;
246 n->ttl_in_seconds = h->ttl;
248 return CDP_ERROR_NONE;
251 /* scan a cdp packet; header, then tlv's */
253 cdp_packet_scan (cdp_main_t * cm, cdp_neighbor_t * n)
255 u8 *end, *cur = n->last_rx_pkt;
258 cdp_error_t e = CDP_ERROR_NONE;
259 tlv_handler_t *handler;
260 cdp_error_t (*fp) (cdp_main_t *, cdp_neighbor_t *, cdp_tlv_t *);
261 u16 computed_checksum;
263 computed_checksum = cdp_checksum (cur, vec_len (cur));
265 if (computed_checksum)
266 return CDP_ERROR_CHECKSUM;
268 h = (cdp_hdr_t *) cur;
270 e = process_cdp_hdr (cm, n, h);
275 if (vec_len (n->last_rx_pkt) <= 0)
276 return CDP_ERROR_BAD_TLV;
278 cur = (u8 *) (h + 1);
279 end = n->last_rx_pkt + vec_len (n->last_rx_pkt) - 1;
281 // look ahead 4 bytes (u16 tlv->t + u16 tlv->l)
282 while (cur + 3 <= end)
284 tlv = (cdp_tlv_t *) cur;
285 tlv->t = ntohs (tlv->t);
286 tlv->l = ntohs (tlv->l);
288 /* tlv length includes t, l and v */
291 return CDP_ERROR_BAD_TLV;
295 return CDP_ERROR_BAD_TLV;
298 * Only process known TLVs. In practice, certain
299 * devices send tlv->t = 0xFF, perhaps as an EOF of sorts.
301 if (tlv->t < ARRAY_LEN (tlv_handlers))
303 handler = &tlv_handlers[tlv->t];
304 fp = handler->process;
305 e = (*fp) (cm, n, tlv);
311 // did not process all tlvs or none tlv processed
312 if ((cur - 1) != end)
313 return CDP_ERROR_BAD_TLV;
315 return CDP_ERROR_NONE;
322 cdp_input (vlib_main_t * vm, vlib_buffer_t * b0, u32 bi0)
324 cdp_main_t *cm = &cdp_main;
328 uword last_packet_signature;
330 /* find or create a neighbor pool entry for the (sw) interface
331 upon which we received this pkt */
332 p = hash_get (cm->neighbor_by_sw_if_index,
333 vnet_buffer (b0)->sw_if_index[VLIB_RX]);
337 pool_get (cm->neighbors, n);
338 clib_memset (n, 0, sizeof (*n));
339 n->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
340 n->packet_template_index = (u8) ~ 0;
341 hash_set (cm->neighbor_by_sw_if_index, n->sw_if_index,
346 n = pool_elt_at_index (cm->neighbors, p[0]);
350 * typical clib idiom. Don't repeatedly allocate and free
351 * the per-neighbor rx buffer. Reset its apparent length to zero
356 vec_set_len (n->last_rx_pkt, 0);
358 /* cdp disabled on this interface, we're done */
360 return CDP_ERROR_DISABLED;
363 * Make sure the per-neighbor rx buffer is big enough to hold
364 * the data we're about to copy
366 vec_validate (n->last_rx_pkt, vlib_buffer_length_in_chain (vm, b0) - 1);
369 * Coalesce / copy e the buffer chain into the per-neighbor
372 nbytes = vlib_buffer_contents (vm, bi0, n->last_rx_pkt);
373 ASSERT (nbytes <= vec_len (n->last_rx_pkt));
376 * Compute Jenkins hash of the new packet, decide if we need to
377 * actually parse through the TLV's. CDP packets are all identical,
378 * so unless we time out the peer, we don't need to process the packet.
380 last_packet_signature =
381 hash_memory (n->last_rx_pkt, vec_len (n->last_rx_pkt), 0xd00b);
383 if (n->last_packet_signature_valid &&
384 n->last_packet_signature == last_packet_signature)
386 e = CDP_ERROR_CACHE_HIT;
390 /* Actually scan the packet */
391 e = cdp_packet_scan (cm, n);
392 n->last_packet_signature_valid = 1;
393 n->last_packet_signature = last_packet_signature;
396 if (e == CDP_ERROR_NONE)
398 n->last_heard = vlib_time_now (vm);
405 * setup neighbor hash table
407 static clib_error_t *
408 cdp_input_init (vlib_main_t * vm)
410 cdp_main_t *cm = &cdp_main;
413 cm->vnet_main = vnet_get_main ();
414 cm->neighbor_by_sw_if_index = hash_create (0, sizeof (uword));
419 VLIB_INIT_FUNCTION (cdp_input_init) =
421 .runs_after = VLIB_INITS("cdp_periodic_init"),
426 format_cdp_neighbors (u8 * s, va_list * va)
428 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
429 cdp_main_t *cm = va_arg (*va, cdp_main_t *);
430 vnet_main_t *vnm = &vnet_main;
432 vnet_hw_interface_t *hw;
435 "%=25s %=25s %=25s %=10s\n",
436 "Our Port", "Peer System", "Peer Port", "Last Heard");
438 pool_foreach (n, cm->neighbors)
440 hw = vnet_get_sup_hw_interface (vnm, n->sw_if_index);
442 if (n->disabled == 0)
443 s = format (s, "%=25v %=25s %=25s %=10.1f\n",
444 hw->name, n->device_name, n->port_id,
450 static clib_error_t *
451 show_cdp (vlib_main_t * vm,
452 unformat_input_t * input, vlib_cli_command_t * cmd)
454 cdp_main_t *cm = &cdp_main;
456 if (cm->enabled == 0)
457 vlib_cli_output (vm, "CDP is not enabled...");
459 vlib_cli_output (vm, "%U\n", format_cdp_neighbors, vm, cm);
464 VLIB_CLI_COMMAND (show_cdp_command, static) = {
466 .short_help = "Show cdp command",
467 .function = show_cdp,
472 * packet trace format function, very similar to
473 * cdp_packet_scan except that we call the per TLV format
474 * functions instead of the per TLV processing functions
477 cdp_input_format_trace (u8 * s, va_list * args)
479 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
480 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
481 cdp_input_trace_t *t = va_arg (*args, cdp_input_trace_t *);
485 tlv_handler_t *handler;
486 u8 *(*fp) (cdp_tlv_t *);
490 h = (cdp_hdr_t *) cur;
491 s = format (s, "%U", format_cdp_hdr, h);
493 cur = (u8 *) (h + 1);
495 while (cur < t->data + t->len)
497 tlv = (cdp_tlv_t *) cur;
498 tlv->t = ntohs (tlv->t);
499 tlv->l = ntohs (tlv->l);
500 if (tlv->t >= ARRAY_LEN (tlv_handlers))
502 s = format (s, "BAD_TLV\n");
505 handler = &tlv_handlers[tlv->t];
506 fp = handler->format;
507 s = format (s, " %U", fp, tlv);
508 /* tlv length includes (t, l) */
516 * fd.io coding-style-patch-verification: ON
519 * eval: (c-set-style "gnu")