| /* |
| * Copyright (c) 2011-2018 Cisco and/or its affiliates. |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at: |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| #include <cdp/cdp.h> |
| #include <vppinfra/hash.h> |
| #include <vppinfra/pcap.h> |
| #include <vnet/srp/srp.h> |
| #include <vnet/ppp/ppp.h> |
| #include <vnet/hdlc/hdlc.h> |
| #include <vnet/srp/packet.h> |
| |
| /* |
| * Generate a set of specific CDP TLVs. |
| * |
| * $$$ eventually these need to fish better data from |
| * other data structures; e.g. the hostname, software version info |
| * etc. |
| */ |
| |
| static void |
| add_device_name_tlv (vnet_hw_interface_t * hw, u8 ** t0p) |
| { |
| cdp_tlv_t *t = (cdp_tlv_t *) * t0p; |
| |
| t->t = htons (CDP_TLV_device_name); |
| t->l = htons (3 + sizeof (*t)); |
| clib_memcpy (&t->v, "VPP", 3); |
| |
| *t0p += ntohs (t->l); |
| } |
| |
| static void |
| add_port_id_tlv (vnet_hw_interface_t * hw, u8 ** t0p) |
| { |
| cdp_tlv_t *t = (cdp_tlv_t *) * t0p; |
| |
| t->t = htons (CDP_TLV_port_id); |
| t->l = htons (vec_len (hw->name) + sizeof (*t)); |
| clib_memcpy (&t->v, hw->name, vec_len (hw->name)); |
| *t0p += ntohs (t->l); |
| } |
| |
| static void |
| add_version_tlv (vnet_hw_interface_t * hw, u8 ** t0p) |
| { |
| cdp_tlv_t *t = (cdp_tlv_t *) * t0p; |
| |
| t->t = htons (CDP_TLV_version); |
| t->l = htons (12 + sizeof (*t)); |
| clib_memcpy (&t->v, "VPP Software", 12); |
| *t0p += ntohs (t->l); |
| } |
| |
| static void |
| add_platform_tlv (vnet_hw_interface_t * hw, u8 ** t0p) |
| { |
| cdp_tlv_t *t = (cdp_tlv_t *) * t0p; |
| |
| t->t = htons (CDP_TLV_platform); |
| t->l = htons (2 + sizeof (*t)); |
| clib_memcpy (&t->v, "SW", 2); |
| *t0p += ntohs (t->l); |
| } |
| |
| static void |
| add_capability_tlv (vnet_hw_interface_t * hw, u8 ** t0p) |
| { |
| cdp_tlv_t *t = (cdp_tlv_t *) * t0p; |
| u32 capabilities; |
| |
| t->t = htons (CDP_TLV_capabilities); |
| t->l = htons (4 + sizeof (*t)); |
| capabilities = CDP_ROUTER_DEVICE; |
| capabilities = htonl (capabilities); |
| clib_memcpy (&t->v, &capabilities, sizeof (capabilities)); |
| *t0p += ntohs (t->l); |
| } |
| |
| static void |
| add_tlvs (cdp_main_t * cm, vnet_hw_interface_t * hw, u8 ** t0p) |
| { |
| add_device_name_tlv (hw, t0p); |
| add_port_id_tlv (hw, t0p); |
| add_version_tlv (hw, t0p); |
| add_platform_tlv (hw, t0p); |
| add_capability_tlv (hw, t0p); |
| } |
| |
| /* |
| * send a cdp pkt on an ethernet interface |
| */ |
| static void |
| send_ethernet_hello (cdp_main_t * cm, cdp_neighbor_t * n, int count) |
| { |
| u32 *to_next; |
| ethernet_llc_snap_and_cdp_header_t *h0; |
| vnet_hw_interface_t *hw; |
| u32 bi0; |
| vlib_buffer_t *b0; |
| u8 *t0; |
| u16 checksum; |
| int nbytes_to_checksum; |
| int i; |
| vlib_frame_t *f; |
| vlib_main_t *vm = cm->vlib_main; |
| vnet_main_t *vnm = cm->vnet_main; |
| |
| for (i = 0; i < count; i++) |
| { |
| /* |
| * see cdp_periodic_init() to understand what's already painted |
| * into the buffer by the packet template mechanism |
| */ |
| h0 = vlib_packet_template_get_packet |
| (vm, &cm->packet_templates[n->packet_template_index], &bi0); |
| |
| if (!h0) |
| break; |
| |
| /* Add the interface's ethernet source address */ |
| hw = vnet_get_sup_hw_interface (vnm, n->sw_if_index); |
| |
| clib_memcpy (h0->ethernet.src_address, hw->hw_address, |
| vec_len (hw->hw_address)); |
| |
| t0 = (u8 *) & h0->cdp.data; |
| |
| /* add TLVs */ |
| add_tlvs (cm, hw, &t0); |
| |
| /* add the cdp packet checksum */ |
| nbytes_to_checksum = t0 - (u8 *) & h0->cdp; |
| checksum = cdp_checksum (&h0->cdp, nbytes_to_checksum); |
| h0->cdp.checksum = htons (checksum); |
| |
| /* Set the outbound packet length */ |
| b0 = vlib_get_buffer (vm, bi0); |
| b0->current_length = nbytes_to_checksum + sizeof (*h0) |
| - sizeof (cdp_hdr_t); |
| |
| /* And the outbound interface */ |
| vnet_buffer (b0)->sw_if_index[VLIB_TX] = hw->sw_if_index; |
| |
| /* Set the 802.3 ethernet length */ |
| h0->ethernet.len = htons (b0->current_length |
| - sizeof (ethernet_802_3_header_t)); |
| |
| /* And output the packet on the correct interface */ |
| f = vlib_get_frame_to_node (vm, hw->output_node_index); |
| to_next = vlib_frame_vector_args (f); |
| to_next[0] = bi0; |
| f->n_vectors = 1; |
| |
| vlib_put_frame_to_node (vm, hw->output_node_index, f); |
| n->last_sent = vlib_time_now (vm); |
| } |
| } |
| |
| /* |
| * send a cdp pkt on an hdlc interface |
| */ |
| static void |
| send_hdlc_hello (cdp_main_t * cm, cdp_neighbor_t * n, int count) |
| { |
| u32 *to_next; |
| hdlc_and_cdp_header_t *h0; |
| vnet_hw_interface_t *hw; |
| u32 bi0; |
| vlib_buffer_t *b0; |
| u8 *t0; |
| u16 checksum; |
| int nbytes_to_checksum; |
| int i; |
| vlib_frame_t *f; |
| vlib_main_t *vm = cm->vlib_main; |
| vnet_main_t *vnm = cm->vnet_main; |
| |
| for (i = 0; i < count; i++) |
| { |
| /* |
| * see cdp_periodic_init() to understand what's already painted |
| * into the buffer by the packet template mechanism |
| */ |
| h0 = vlib_packet_template_get_packet |
| (vm, &cm->packet_templates[n->packet_template_index], &bi0); |
| |
| if (!h0) |
| break; |
| |
| hw = vnet_get_sup_hw_interface (vnm, n->sw_if_index); |
| |
| t0 = (u8 *) & h0->cdp.data; |
| |
| /* add TLVs */ |
| add_tlvs (cm, hw, &t0); |
| |
| /* add the cdp packet checksum */ |
| nbytes_to_checksum = t0 - (u8 *) & h0->cdp; |
| checksum = cdp_checksum (&h0->cdp, nbytes_to_checksum); |
| h0->cdp.checksum = htons (checksum); |
| |
| /* Set the outbound packet length */ |
| b0 = vlib_get_buffer (vm, bi0); |
| b0->current_length = nbytes_to_checksum + sizeof (*h0) |
| - sizeof (cdp_hdr_t); |
| |
| /* And output the packet on the correct interface */ |
| f = vlib_get_frame_to_node (vm, hw->output_node_index); |
| to_next = vlib_frame_vector_args (f); |
| to_next[0] = bi0; |
| f->n_vectors = 1; |
| |
| vlib_put_frame_to_node (vm, hw->output_node_index, f); |
| n->last_sent = vlib_time_now (vm); |
| } |
| } |
| |
| /* |
| * send a cdp pkt on an srp interface |
| */ |
| static void |
| send_srp_hello (cdp_main_t * cm, cdp_neighbor_t * n, int count) |
| { |
| u32 *to_next; |
| srp_and_cdp_header_t *h0; |
| vnet_hw_interface_t *hw; |
| u32 bi0; |
| vlib_buffer_t *b0; |
| u8 *t0; |
| u16 checksum; |
| int nbytes_to_checksum; |
| int i; |
| vlib_frame_t *f; |
| vlib_main_t *vm = cm->vlib_main; |
| vnet_main_t *vnm = cm->vnet_main; |
| |
| for (i = 0; i < count; i++) |
| { |
| /* |
| * see cdp_periodic_init() to understand what's already painted |
| * into the buffer by the packet template mechanism |
| */ |
| h0 = vlib_packet_template_get_packet |
| (vm, &cm->packet_templates[n->packet_template_index], &bi0); |
| |
| if (!h0) |
| break; |
| |
| hw = vnet_get_sup_hw_interface (vnm, n->sw_if_index); |
| |
| t0 = (u8 *) & h0->cdp.data; |
| |
| /* add TLVs */ |
| add_tlvs (cm, hw, &t0); |
| |
| /* Add the interface's ethernet source address */ |
| clib_memcpy (h0->ethernet.src_address, hw->hw_address, |
| vec_len (hw->hw_address)); |
| |
| /* add the cdp packet checksum */ |
| nbytes_to_checksum = t0 - (u8 *) & h0->cdp; |
| checksum = cdp_checksum (&h0->cdp, nbytes_to_checksum); |
| h0->cdp.checksum = htons (checksum); |
| |
| /* Set the outbound packet length */ |
| b0 = vlib_get_buffer (vm, bi0); |
| b0->current_length = nbytes_to_checksum + sizeof (*h0) |
| - sizeof (cdp_hdr_t); |
| |
| /* And output the packet on the correct interface */ |
| f = vlib_get_frame_to_node (vm, hw->output_node_index); |
| to_next = vlib_frame_vector_args (f); |
| to_next[0] = bi0; |
| f->n_vectors = 1; |
| |
| vlib_put_frame_to_node (vm, hw->output_node_index, f); |
| n->last_sent = vlib_time_now (vm); |
| } |
| } |
| |
| /* |
| * Decide which cdp packet template to use |
| */ |
| static int |
| pick_packet_template (cdp_main_t * cm, cdp_neighbor_t * n) |
| { |
| n->packet_template_index = CDP_PACKET_TEMPLATE_ETHERNET; |
| |
| return 0; |
| } |
| |
| /* Send a cdp neighbor announcement */ |
| static void |
| send_hello (cdp_main_t * cm, cdp_neighbor_t * n, int count) |
| { |
| if (n->packet_template_index == (u8) ~ 0) |
| { |
| /* If we don't know how to talk to this peer, don't try again */ |
| if (pick_packet_template (cm, n)) |
| { |
| n->last_sent = 1e70; |
| return; |
| } |
| } |
| |
| switch (n->packet_template_index) |
| { |
| case CDP_PACKET_TEMPLATE_ETHERNET: |
| send_ethernet_hello (cm, n, count); |
| break; |
| |
| case CDP_PACKET_TEMPLATE_HDLC: |
| send_hdlc_hello (cm, n, count); |
| break; |
| |
| case CDP_PACKET_TEMPLATE_SRP: |
| send_srp_hello (cm, n, count); |
| break; |
| |
| default: |
| ASSERT (0); |
| } |
| n->last_sent = vlib_time_now (cm->vlib_main); |
| } |
| |
| static void |
| delete_neighbor (cdp_main_t * cm, cdp_neighbor_t * n, int want_broadcast) |
| { |
| hash_unset (cm->neighbor_by_sw_if_index, n->sw_if_index); |
| vec_free (n->device_name); |
| vec_free (n->version); |
| vec_free (n->port_id); |
| vec_free (n->platform); |
| vec_free (n->last_rx_pkt); |
| pool_put (cm->neighbors, n); |
| } |
| |
| void |
| cdp_periodic (vlib_main_t * vm) |
| { |
| cdp_main_t *cm = &cdp_main; |
| cdp_neighbor_t *n; |
| f64 now = vlib_time_now (vm); |
| vnet_sw_interface_t *sw; |
| static u32 *delete_list = 0; |
| int i; |
| static cdp_neighbor_t **n_list = 0; |
| |
| /* *INDENT-OFF* */ |
| pool_foreach (n, cm->neighbors) |
| { |
| vec_add1 (n_list, n); |
| } |
| /* *INDENT-ON* */ |
| |
| /* Across all cdp neighbors known to the system */ |
| for (i = 0; i < vec_len (n_list); i++) |
| { |
| n = n_list[i]; |
| |
| /* "no cdp run" provisioned on the interface? */ |
| if (n->disabled == 1) |
| continue; |
| |
| sw = vnet_get_sw_interface (cm->vnet_main, n->sw_if_index); |
| |
| /* Interface shutdown or rx timeout? */ |
| if (!(sw->flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) |
| || (now > (n->last_heard + (f64) n->ttl_in_seconds))) |
| /* add to list of neighbors to delete */ |
| vec_add1 (delete_list, n - cm->neighbors); |
| else if (n->last_sent == 0.0) |
| /* First time, send 3 hellos */ |
| send_hello (cm, n, 3 /* three to begin with */ ); |
| else if (now > (n->last_sent + (((f64) n->ttl_in_seconds) / 6.0))) |
| /* Normal keepalive, send one */ |
| send_hello (cm, n, 1 /* one as a keepalive */ ); |
| } |
| |
| for (i = 0; i < vec_len (delete_list); i++) |
| { |
| n = vec_elt_at_index (cm->neighbors, delete_list[i]); |
| delete_neighbor (cm, n, 1); |
| } |
| if (delete_list) |
| _vec_len (delete_list) = 0; |
| if (n_list) |
| _vec_len (n_list) = 0; |
| } |
| |
| static clib_error_t * |
| cdp_periodic_init (vlib_main_t * vm) |
| { |
| cdp_main_t *cm = &cdp_main; |
| |
| /* Create the ethernet cdp hello packet template */ |
| { |
| ethernet_llc_snap_and_cdp_header_t h; |
| |
| clib_memset (&h, 0, sizeof (h)); |
| |
| /* Send to 01:00:0c:cc:cc */ |
| h.ethernet.dst_address[0] = 0x01; |
| /* h.ethernet.dst_address[1] = 0x00; (clib_memset) */ |
| h.ethernet.dst_address[2] = 0x0C; |
| h.ethernet.dst_address[3] = 0xCC; |
| h.ethernet.dst_address[4] = 0xCC; |
| h.ethernet.dst_address[5] = 0xCC; |
| |
| /* leave src address blank (fill in at send time) */ |
| |
| /* leave length blank (fill in at send time) */ |
| |
| /* LLC */ |
| h.llc.dst_sap = h.llc.src_sap = 0xAA; /* SNAP */ |
| h.llc.control = 0x03; /* UI (no extended control bytes) */ |
| |
| /* SNAP */ |
| /* h.snap.oui[0] = 0x00; (clib_memset) */ |
| /* h.snap.oui[1] = 0x00; (clib_memset) */ |
| h.snap.oui[2] = 0x0C; /* Cisco = 0x00000C */ |
| h.snap.protocol = htons (0x2000); /* CDP = 0x2000 */ |
| |
| /* CDP */ |
| h.cdp.version = 2; |
| h.cdp.ttl = 180; |
| |
| vlib_packet_template_init |
| (vm, &cm->packet_templates[CDP_PACKET_TEMPLATE_ETHERNET], |
| /* data */ &h, |
| sizeof (h), |
| /* alloc chunk size */ 8, |
| "cdp-ethernet"); |
| } |
| |
| #if 0 /* retain for reference */ |
| |
| /* Create the hdlc cdp hello packet template */ |
| { |
| hdlc_and_cdp_header_t h; |
| |
| clib_memset (&h, 0, sizeof (h)); |
| |
| h.hdlc.address = 0x0f; |
| /* h.hdlc.control = 0; (clib_memset) */ |
| h.hdlc.protocol = htons (0x2000); /* CDP = 0x2000 */ |
| |
| /* CDP */ |
| h.cdp.version = 2; |
| h.cdp.ttl = 180; |
| |
| vlib_packet_template_init |
| (vm, &cm->packet_templates[CDP_PACKET_TEMPLATE_HDLC], |
| /* data */ &h, |
| sizeof (h), |
| /* alloc chunk size */ 8, |
| "cdp-hdlc"); |
| } |
| |
| /* Create the srp cdp hello packet template */ |
| { |
| srp_and_cdp_header_t h; |
| |
| clib_memset (&h, 0, sizeof (h)); |
| |
| /* Send to 01:00:0c:cc:cc */ |
| h.ethernet.dst_address[0] = 0x01; |
| /* h.ethernet.dst_address[1] = 0x00; (clib_memset) */ |
| h.ethernet.dst_address[2] = 0x0C; |
| h.ethernet.dst_address[3] = 0xCC; |
| h.ethernet.dst_address[4] = 0xCC; |
| h.ethernet.dst_address[5] = 0xCC; |
| |
| /* leave src address blank (fill in at send time) */ |
| |
| /* The srp header is filled in at xmt */ |
| h.srp.ttl = 1; |
| h.srp.priority = 7; |
| h.srp.mode = SRP_MODE_data; |
| srp_header_compute_parity (&h.srp); |
| |
| /* Inner ring and parity will be set at send time */ |
| |
| h.ethernet.type = htons (0x2000); /* CDP = 0x2000 */ |
| |
| /* CDP */ |
| h.cdp.version = 2; |
| h.cdp.ttl = 180; |
| |
| vlib_packet_template_init |
| (vm, &cm->packet_templates[CDP_PACKET_TEMPLATE_SRP], |
| /* data */ &h, |
| sizeof (h), |
| /* alloc chunk size */ 8, |
| "cdp-srp"); |
| } |
| #endif |
| |
| return 0; |
| } |
| |
| VLIB_INIT_FUNCTION (cdp_periodic_init); |
| |
| /* |
| * fd.io coding-style-patch-verification: ON |
| * |
| * Local Variables: |
| * eval: (c-set-style "gnu") |
| * End: |
| */ |