src/vnet/lldp/lldp_output.c - fdio/vpp - Gitiles

 /*
  * Copyright (c) 2011-2016 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.
  */
 /**
  * @file
  * @brief LLDP packet generation implementation
  */
 #include <vnet/lldp/lldp_node.h>

 static void
 lldp_build_mgmt_addr_tlv (u8 ** t0p, u8 subtype, u8 addr_len, u8 * addr,
 			  u32 if_index, u8 oid_len, u8 * oid)
 {
   lldp_tlv_t *t = (lldp_tlv_t *) * t0p;

   lldp_tlv_set_code (t, LLDP_TLV_NAME (mgmt_addr));
   t->v[0] = addr_len + 1;	/* address string length */
   t->v[1] = subtype;		/* address subtype */
   clib_memcpy (&(t->v[2]), addr, addr_len);	/* address */
   t->v[addr_len + 2] = 2;	/* interface numbering subtype: ifIndex */
   t->v[addr_len + 3] = (if_index >> 24) & 0xFF;	/* interface number */
   t->v[addr_len + 4] = (if_index >> 16) & 0xFF;
   t->v[addr_len + 5] = (if_index >> 8) & 0xFF;
   t->v[addr_len + 6] = (if_index >> 0) & 0xFF;
   t->v[addr_len + 7] = oid_len;	/* OID string length */

   if (oid_len > 0)
     clib_memcpy ((u8 *) & (t->v[addr_len + 8]), oid, oid_len);

   lldp_tlv_set_length (t, addr_len + oid_len + 8);
   *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + addr_len + oid_len + 8;
 }

 static void
 lldp_add_chassis_id (const vnet_hw_interface_t * hw, u8 ** t0p)
 {
   lldp_chassis_id_tlv_t *t = (lldp_chassis_id_tlv_t *) * t0p;

   lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (chassis_id));
   t->subtype = LLDP_CHASS_ID_SUBTYPE_NAME (mac_addr);

   const size_t addr_len = 6;
   clib_memcpy (&t->id, hw->hw_address, addr_len);
   const size_t len =
     STRUCT_SIZE_OF (lldp_chassis_id_tlv_t, subtype) + addr_len;
   lldp_tlv_set_length ((lldp_tlv_t *) t, len);
   *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
 }

 static void
 lldp_add_port_id (const vnet_hw_interface_t * hw, u8 ** t0p)
 {
   lldp_port_id_tlv_t *t = (lldp_port_id_tlv_t *) * t0p;

   lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (port_id));
   t->subtype = LLDP_PORT_ID_SUBTYPE_NAME (intf_name);

   const size_t name_len = vec_len (hw->name);
   clib_memcpy (&t->id, hw->name, name_len);
   const size_t len = STRUCT_SIZE_OF (lldp_port_id_tlv_t, subtype) + name_len;
   lldp_tlv_set_length ((lldp_tlv_t *) t, len);
   *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
 }

 static void
 lldp_add_ttl (const lldp_main_t * lm, u8 ** t0p, int shutdown)
 {
   lldp_ttl_tlv_t *t = (lldp_ttl_tlv_t *) * t0p;
   lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (ttl));
   if (shutdown)
     {
       t->ttl = 0;
     }
   else
     {
       if ((size_t) lm->msg_tx_interval * lm->msg_tx_hold + 1 > (1 << 16) - 1)
 	{
 	  t->ttl = htons ((1 << 16) - 1);
 	}
       else
 	{
 	  t->ttl = htons (lm->msg_tx_hold * lm->msg_tx_interval + 1);
 	}
     }
   const size_t len = STRUCT_SIZE_OF (lldp_ttl_tlv_t, ttl);
   lldp_tlv_set_length ((lldp_tlv_t *) t, len);
   *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
 }

 static void
 lldp_add_port_desc (const lldp_main_t * lm, lldp_intf_t * n, u8 ** t0p)
 {
   const size_t len = vec_len (n->port_desc);
   if (len)
     {
       lldp_tlv_t *t = (lldp_tlv_t *) * t0p;
       lldp_tlv_set_code (t, LLDP_TLV_NAME (port_desc));
       lldp_tlv_set_length (t, len);
       clib_memcpy (t->v, n->port_desc, len);
       *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
     }
 }

 static void
 lldp_add_sys_name (const lldp_main_t * lm, u8 ** t0p)
 {
   const size_t len = vec_len (lm->sys_name);
   if (len)
     {
       lldp_tlv_t *t = (lldp_tlv_t *) * t0p;
       lldp_tlv_set_code (t, LLDP_TLV_NAME (sys_name));
       lldp_tlv_set_length (t, len);
       clib_memcpy (t->v, lm->sys_name, len);
       *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
     }
 }

 static void
 lldp_add_mgmt_addr (const lldp_intf_t * n, const vnet_hw_interface_t * hw,
 		    u8 ** t0p)
 {
   const size_t len_ip4 = vec_len (n->mgmt_ip4);
   const size_t len_ip6 = vec_len (n->mgmt_ip6);

   if (!(len_ip4 | len_ip6))
     {
       /*
          If no management address is configured, the interface port's MAC
          addressis sent in one TLV.
        */

       lldp_build_mgmt_addr_tlv (t0p, 1,	/* address subtype: Ipv4 */
 				6,	/* address string lenth */
 				hw->hw_address,	/* address */
 				hw->hw_if_index,	/* if index */
 				vec_len (n->mgmt_oid),	/* OID length */
 				n->mgmt_oid);	/* OID */
       return;
     }

   if (len_ip4)
     {
       lldp_build_mgmt_addr_tlv (t0p, 1,	/* address subtype: Ipv4 */
 				len_ip4,	/* address string lenth */
 				n->mgmt_ip4,	/* address */
 				hw->hw_if_index,	/* if index */
 				vec_len (n->mgmt_oid),	/* OID length */
 				n->mgmt_oid);	/* OID */
     }

   if (len_ip6)
     {
       lldp_build_mgmt_addr_tlv (t0p, 2,	/* address subtype: Ipv6 */
 				len_ip6,	/* address string lenth */
 				n->mgmt_ip6,	/* address */
 				hw->hw_if_index,	/* if index */
 				vec_len (n->mgmt_oid),	/* OID length */
 				n->mgmt_oid);	/* OID */
     }
 }

 static void
 lldp_add_pdu_end (u8 ** t0p)
 {
   lldp_tlv_t *t = (lldp_tlv_t *) * t0p;
   lldp_tlv_set_code (t, LLDP_TLV_NAME (pdu_end));
   lldp_tlv_set_length (t, 0);
   *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head);
 }

 static void
 lldp_add_tlvs (lldp_main_t * lm, vnet_hw_interface_t * hw, u8 ** t0p,
 	       int shutdown, lldp_intf_t * n)
 {
   lldp_add_chassis_id (hw, t0p);
   lldp_add_port_id (hw, t0p);
   lldp_add_ttl (lm, t0p, shutdown);
   lldp_add_port_desc (lm, n, t0p);
   lldp_add_sys_name (lm, t0p);
   lldp_add_mgmt_addr (n, hw, t0p);
   lldp_add_pdu_end (t0p);
 }

 /*
  * send a lldp pkt on an ethernet interface
  */
 void
 lldp_send_ethernet (lldp_main_t * lm, lldp_intf_t * n, int shutdown)
 {
   u32 *to_next;
   ethernet_header_t *h0;
   vnet_hw_interface_t *hw;
   u32 bi0;
   vlib_buffer_t *b0;
   u8 *t0;
   vlib_frame_t *f;
   vlib_main_t *vm = lm->vlib_main;
   vnet_main_t *vnm = lm->vnet_main;

   /*
    * see lldp_template_init() to understand what's already painted
    * into the buffer by the packet template mechanism
    */
   h0 = vlib_packet_template_get_packet (vm, &lm->packet_template, &bi0);

   if (!h0)
     return;

   /* Add the interface's ethernet source address */
   hw = vnet_get_hw_interface (vnm, n->hw_if_index);

   clib_memcpy (h0->src_address, hw->hw_address, vec_len (hw->hw_address));

   u8 *data = ((u8 *) h0) + sizeof (*h0);
   t0 = data;

   /* add TLVs */
   lldp_add_tlvs (lm, hw, &t0, shutdown, n);

   /* Set the outbound packet length */
   b0 = vlib_get_buffer (vm, bi0);
   b0->current_length = sizeof (*h0) + t0 - data;

   /* And the outbound interface */
   vnet_buffer (b0)->sw_if_index[VLIB_TX] = hw->sw_if_index;

   /* 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);
 }

 void
 lldp_delete_intf (lldp_main_t * lm, lldp_intf_t * n)
 {
   if (n)
     {
       lldp_unschedule_intf (lm, n);
       hash_unset (lm->intf_by_hw_if_index, n->hw_if_index);
       vec_free (n->chassis_id);
       vec_free (n->port_id);
       vec_free (n->port_desc);
       vec_free (n->mgmt_ip4);
       vec_free (n->mgmt_ip6);
       vec_free (n->mgmt_oid);
       pool_put (lm->intfs, n);
     }
 }

 static clib_error_t *
 lldp_template_init (vlib_main_t * vm)
 {
   lldp_main_t *lm = &lldp_main;

   /* Create the ethernet lldp packet template */
   {
     ethernet_header_t h;

     memset (&h, 0, sizeof (h));

     /*
      * Send to 01:80:C2:00:00:0E - propagation constrained to a single
      * physical link - stopped by all type of bridge
      */
     h.dst_address[0] = 0x01;
     h.dst_address[1] = 0x80;
     h.dst_address[2] = 0xC2;
     /* h.dst_address[3] = 0x00; (memset) */
     /* h.dst_address[4] = 0x00; (memset) */
     h.dst_address[5] = 0x0E;

     /* leave src address blank (fill in at send time) */

     h.type = htons (ETHERNET_TYPE_802_1_LLDP);

     vlib_packet_template_init (vm, &lm->packet_template,
 			       /* data */ &h, sizeof (h),
 			       /* alloc chunk size */ 8, "lldp-ethernet");
   }

   return 0;
 }

 VLIB_INIT_FUNCTION (lldp_template_init);

 /*
  * fd.io coding-style-patch-verification: ON
  *
  * Local Variables:
  * eval: (c-set-style "gnu")
  * End:
  */
	/*
	* Copyright (c) 2011-2016 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.
	*/
	/**
	* @file
	* @brief LLDP packet generation implementation
	*/
	#include <vnet/lldp/lldp_node.h>

	static void
	lldp_build_mgmt_addr_tlv (u8 ** t0p, u8 subtype, u8 addr_len, u8 * addr,
	u32 if_index, u8 oid_len, u8 * oid)
	{
	lldp_tlv_t t = (lldp_tlv_t ) * t0p;

	lldp_tlv_set_code (t, LLDP_TLV_NAME (mgmt_addr));
	t->v[0] = addr_len + 1; /* address string length */
	t->v[1] = subtype; /* address subtype */
	clib_memcpy (&(t->v[2]), addr, addr_len); /* address */
	t->v[addr_len + 2] = 2; /* interface numbering subtype: ifIndex */
	t->v[addr_len + 3] = (if_index >> 24) & 0xFF; /* interface number */
	t->v[addr_len + 4] = (if_index >> 16) & 0xFF;
	t->v[addr_len + 5] = (if_index >> 8) & 0xFF;
	t->v[addr_len + 6] = (if_index >> 0) & 0xFF;
	t->v[addr_len + 7] = oid_len; /* OID string length */

	if (oid_len > 0)
	clib_memcpy ((u8 *) & (t->v[addr_len + 8]), oid, oid_len);

	lldp_tlv_set_length (t, addr_len + oid_len + 8);
	*t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + addr_len + oid_len + 8;
	}

	static void
	lldp_add_chassis_id (const vnet_hw_interface_t * hw, u8 ** t0p)
	{
	lldp_chassis_id_tlv_t t = (lldp_chassis_id_tlv_t ) * t0p;

	lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (chassis_id));
	t->subtype = LLDP_CHASS_ID_SUBTYPE_NAME (mac_addr);

	const size_t addr_len = 6;
	clib_memcpy (&t->id, hw->hw_address, addr_len);
	const size_t len =
	STRUCT_SIZE_OF (lldp_chassis_id_tlv_t, subtype) + addr_len;
	lldp_tlv_set_length ((lldp_tlv_t *) t, len);
	*t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
	}

	static void
	lldp_add_port_id (const vnet_hw_interface_t * hw, u8 ** t0p)
	{
	lldp_port_id_tlv_t t = (lldp_port_id_tlv_t ) * t0p;

	lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (port_id));
	t->subtype = LLDP_PORT_ID_SUBTYPE_NAME (intf_name);

	const size_t name_len = vec_len (hw->name);
	clib_memcpy (&t->id, hw->name, name_len);
	const size_t len = STRUCT_SIZE_OF (lldp_port_id_tlv_t, subtype) + name_len;
	lldp_tlv_set_length ((lldp_tlv_t *) t, len);
	*t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
	}

	static void
	lldp_add_ttl (const lldp_main_t * lm, u8 ** t0p, int shutdown)
	{
	lldp_ttl_tlv_t t = (lldp_ttl_tlv_t ) * t0p;
	lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (ttl));
	if (shutdown)
	{
	t->ttl = 0;
	}
	else
	{
	if ((size_t) lm->msg_tx_interval * lm->msg_tx_hold + 1 > (1 << 16) - 1)
	{
	t->ttl = htons ((1 << 16) - 1);
	}
	else
	{
	t->ttl = htons (lm->msg_tx_hold * lm->msg_tx_interval + 1);
	}
	}
	const size_t len = STRUCT_SIZE_OF (lldp_ttl_tlv_t, ttl);
	lldp_tlv_set_length ((lldp_tlv_t *) t, len);
	*t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
	}

	static void
	lldp_add_port_desc (const lldp_main_t * lm, lldp_intf_t * n, u8 ** t0p)
	{
	const size_t len = vec_len (n->port_desc);
	if (len)
	{
	lldp_tlv_t t = (lldp_tlv_t ) * t0p;
	lldp_tlv_set_code (t, LLDP_TLV_NAME (port_desc));
	lldp_tlv_set_length (t, len);
	clib_memcpy (t->v, n->port_desc, len);
	*t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
	}
	}

	static void
	lldp_add_sys_name (const lldp_main_t * lm, u8 ** t0p)
	{
	const size_t len = vec_len (lm->sys_name);
	if (len)
	{
	lldp_tlv_t t = (lldp_tlv_t ) * t0p;
	lldp_tlv_set_code (t, LLDP_TLV_NAME (sys_name));
	lldp_tlv_set_length (t, len);
	clib_memcpy (t->v, lm->sys_name, len);
	*t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
	}
	}

	static void
	lldp_add_mgmt_addr (const lldp_intf_t * n, const vnet_hw_interface_t * hw,
	u8 ** t0p)
	{
	const size_t len_ip4 = vec_len (n->mgmt_ip4);
	const size_t len_ip6 = vec_len (n->mgmt_ip6);

	if (!(len_ip4 \| len_ip6))
	{
	/*
	If no management address is configured, the interface port's MAC
	addressis sent in one TLV.
	*/

	lldp_build_mgmt_addr_tlv (t0p, 1, /* address subtype: Ipv4 */
	6, /* address string lenth */
	hw->hw_address, /* address */
	hw->hw_if_index, /* if index */
	vec_len (n->mgmt_oid), /* OID length */
	n->mgmt_oid); /* OID */
	return;
	}

	if (len_ip4)
	{
	lldp_build_mgmt_addr_tlv (t0p, 1, /* address subtype: Ipv4 */
	len_ip4, /* address string lenth */
	n->mgmt_ip4, /* address */
	hw->hw_if_index, /* if index */
	vec_len (n->mgmt_oid), /* OID length */
	n->mgmt_oid); /* OID */
	}

	if (len_ip6)
	{
	lldp_build_mgmt_addr_tlv (t0p, 2, /* address subtype: Ipv6 */
	len_ip6, /* address string lenth */
	n->mgmt_ip6, /* address */
	hw->hw_if_index, /* if index */
	vec_len (n->mgmt_oid), /* OID length */
	n->mgmt_oid); /* OID */
	}
	}

	static void
	lldp_add_pdu_end (u8 ** t0p)
	{
	lldp_tlv_t t = (lldp_tlv_t ) * t0p;
	lldp_tlv_set_code (t, LLDP_TLV_NAME (pdu_end));
	lldp_tlv_set_length (t, 0);
	*t0p += STRUCT_SIZE_OF (lldp_tlv_t, head);
	}

	static void
	lldp_add_tlvs (lldp_main_t * lm, vnet_hw_interface_t * hw, u8 ** t0p,
	int shutdown, lldp_intf_t * n)
	{
	lldp_add_chassis_id (hw, t0p);
	lldp_add_port_id (hw, t0p);
	lldp_add_ttl (lm, t0p, shutdown);
	lldp_add_port_desc (lm, n, t0p);
	lldp_add_sys_name (lm, t0p);
	lldp_add_mgmt_addr (n, hw, t0p);
	lldp_add_pdu_end (t0p);
	}

	/*
	* send a lldp pkt on an ethernet interface
	*/
	void
	lldp_send_ethernet (lldp_main_t * lm, lldp_intf_t * n, int shutdown)
	{
	u32 *to_next;
	ethernet_header_t *h0;
	vnet_hw_interface_t *hw;
	u32 bi0;
	vlib_buffer_t *b0;
	u8 *t0;
	vlib_frame_t *f;
	vlib_main_t *vm = lm->vlib_main;
	vnet_main_t *vnm = lm->vnet_main;

	/*
	* see lldp_template_init() to understand what's already painted
	* into the buffer by the packet template mechanism
	*/
	h0 = vlib_packet_template_get_packet (vm, &lm->packet_template, &bi0);

	if (!h0)
	return;

	/* Add the interface's ethernet source address */
	hw = vnet_get_hw_interface (vnm, n->hw_if_index);

	clib_memcpy (h0->src_address, hw->hw_address, vec_len (hw->hw_address));

	u8 data = ((u8 ) h0) + sizeof (*h0);
	t0 = data;

	/* add TLVs */
	lldp_add_tlvs (lm, hw, &t0, shutdown, n);

	/* Set the outbound packet length */
	b0 = vlib_get_buffer (vm, bi0);
	b0->current_length = sizeof (*h0) + t0 - data;

	/* And the outbound interface */
	vnet_buffer (b0)->sw_if_index[VLIB_TX] = hw->sw_if_index;

	/* 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);
	}

	void
	lldp_delete_intf (lldp_main_t * lm, lldp_intf_t * n)
	{
	if (n)
	{
	lldp_unschedule_intf (lm, n);
	hash_unset (lm->intf_by_hw_if_index, n->hw_if_index);
	vec_free (n->chassis_id);
	vec_free (n->port_id);
	vec_free (n->port_desc);
	vec_free (n->mgmt_ip4);
	vec_free (n->mgmt_ip6);
	vec_free (n->mgmt_oid);
	pool_put (lm->intfs, n);
	}
	}

	static clib_error_t *
	lldp_template_init (vlib_main_t * vm)
	{
	lldp_main_t *lm = &lldp_main;

	/* Create the ethernet lldp packet template */
	{
	ethernet_header_t h;

	memset (&h, 0, sizeof (h));

	/*
	* Send to 01:80:C2:00:00:0E - propagation constrained to a single
	* physical link - stopped by all type of bridge
	*/
	h.dst_address[0] = 0x01;
	h.dst_address[1] = 0x80;
	h.dst_address[2] = 0xC2;
	/* h.dst_address[3] = 0x00; (memset) */
	/* h.dst_address[4] = 0x00; (memset) */
	h.dst_address[5] = 0x0E;

	/* leave src address blank (fill in at send time) */

	h.type = htons (ETHERNET_TYPE_802_1_LLDP);

	vlib_packet_template_init (vm, &lm->packet_template,
	/* data */ &h, sizeof (h),
	/* alloc chunk size */ 8, "lldp-ethernet");
	}

	return 0;
	}

	VLIB_INIT_FUNCTION (lldp_template_init);

	/*
	* fd.io coding-style-patch-verification: ON
	*
	* Local Variables:
	* eval: (c-set-style "gnu")
	* End:
	*/