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.
17 * @brief LLDP packet generation implementation
19 #include <vnet/lldp/lldp_node.h>
22 lldp_add_chassis_id (const vnet_hw_interface_t * hw, u8 ** t0p)
24 lldp_chassis_id_tlv_t *t = (lldp_chassis_id_tlv_t *) * t0p;
26 lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (chassis_id));
27 t->subtype = LLDP_CHASS_ID_SUBTYPE_NAME (mac_addr);
29 const size_t addr_len = 6;
30 clib_memcpy (&t->id, hw->hw_address, addr_len);
32 STRUCT_SIZE_OF (lldp_chassis_id_tlv_t, subtype) + addr_len;
33 lldp_tlv_set_length ((lldp_tlv_t *) t, len);
34 *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
38 lldp_add_port_id (const vnet_hw_interface_t * hw, u8 ** t0p)
40 lldp_port_id_tlv_t *t = (lldp_port_id_tlv_t *) * t0p;
42 lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (port_id));
43 t->subtype = LLDP_PORT_ID_SUBTYPE_NAME (intf_name);
45 const size_t name_len = vec_len (hw->name);
46 clib_memcpy (&t->id, hw->name, name_len);
47 const size_t len = STRUCT_SIZE_OF (lldp_port_id_tlv_t, subtype) + name_len;
48 lldp_tlv_set_length ((lldp_tlv_t *) t, len);
49 *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
53 lldp_add_ttl (const lldp_main_t * lm, u8 ** t0p, int shutdown)
55 lldp_ttl_tlv_t *t = (lldp_ttl_tlv_t *) * t0p;
56 lldp_tlv_set_code ((lldp_tlv_t *) t, LLDP_TLV_NAME (ttl));
63 if ((size_t) lm->msg_tx_interval * lm->msg_tx_hold + 1 > (1 << 16) - 1)
65 t->ttl = htons ((1 << 16) - 1);
69 t->ttl = htons (lm->msg_tx_hold * lm->msg_tx_interval + 1);
72 const size_t len = STRUCT_SIZE_OF (lldp_ttl_tlv_t, ttl);
73 lldp_tlv_set_length ((lldp_tlv_t *) t, len);
74 *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
78 lldp_add_sys_name (const lldp_main_t * lm, u8 ** t0p)
80 const size_t len = vec_len (lm->sys_name);
83 lldp_tlv_t *t = (lldp_tlv_t *) * t0p;
84 lldp_tlv_set_code (t, LLDP_TLV_NAME (sys_name));
85 lldp_tlv_set_length (t, len);
86 clib_memcpy (t->v, lm->sys_name, len);
87 *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head) + len;
92 lldp_add_pdu_end (u8 ** t0p)
94 lldp_tlv_t *t = (lldp_tlv_t *) * t0p;
95 lldp_tlv_set_code (t, LLDP_TLV_NAME (pdu_end));
96 lldp_tlv_set_length (t, 0);
97 *t0p += STRUCT_SIZE_OF (lldp_tlv_t, head);
101 lldp_add_tlvs (lldp_main_t * lm, vnet_hw_interface_t * hw, u8 ** t0p,
104 lldp_add_chassis_id (hw, t0p);
105 lldp_add_port_id (hw, t0p);
106 lldp_add_ttl (lm, t0p, shutdown);
107 lldp_add_sys_name (lm, t0p);
108 lldp_add_pdu_end (t0p);
112 * send a lldp pkt on an ethernet interface
115 lldp_send_ethernet (lldp_main_t * lm, lldp_intf_t * n, int shutdown)
118 ethernet_header_t *h0;
119 vnet_hw_interface_t *hw;
124 vlib_main_t *vm = lm->vlib_main;
125 vnet_main_t *vnm = lm->vnet_main;
128 * see lldp_template_init() to understand what's already painted
129 * into the buffer by the packet template mechanism
131 h0 = vlib_packet_template_get_packet (vm, &lm->packet_template, &bi0);
133 /* Add the interface's ethernet source address */
134 hw = vnet_get_hw_interface (vnm, n->hw_if_index);
136 clib_memcpy (h0->src_address, hw->hw_address, vec_len (hw->hw_address));
138 u8 *data = ((u8 *) h0) + sizeof (*h0);
142 lldp_add_tlvs (lm, hw, &t0, shutdown);
144 /* Set the outbound packet length */
145 b0 = vlib_get_buffer (vm, bi0);
146 b0->current_length = sizeof (*h0) + t0 - data;
148 /* And the outbound interface */
149 vnet_buffer (b0)->sw_if_index[VLIB_TX] = hw->sw_if_index;
151 /* And output the packet on the correct interface */
152 f = vlib_get_frame_to_node (vm, hw->output_node_index);
153 to_next = vlib_frame_vector_args (f);
157 vlib_put_frame_to_node (vm, hw->output_node_index, f);
158 n->last_sent = vlib_time_now (vm);
162 lldp_delete_intf (lldp_main_t * lm, lldp_intf_t * n)
166 lldp_unschedule_intf (lm, n);
167 hash_unset (lm->intf_by_hw_if_index, n->hw_if_index);
168 vec_free (n->chassis_id);
169 vec_free (n->port_id);
170 pool_put (lm->intfs, n);
174 static clib_error_t *
175 lldp_template_init (vlib_main_t * vm)
177 lldp_main_t *lm = &lldp_main;
179 /* Create the ethernet lldp packet template */
183 memset (&h, 0, sizeof (h));
186 * Send to 01:80:C2:00:00:0E - propagation constrained to a single
187 * physical link - stopped by all type of bridge
189 h.dst_address[0] = 0x01;
190 h.dst_address[1] = 0x80;
191 h.dst_address[2] = 0xC2;
192 /* h.dst_address[3] = 0x00; (memset) */
193 /* h.dst_address[4] = 0x00; (memset) */
194 h.dst_address[5] = 0x0E;
196 /* leave src address blank (fill in at send time) */
198 h.type = htons (ETHERNET_TYPE_802_1_LLDP);
200 vlib_packet_template_init (vm, &lm->packet_template,
201 /* data */ &h, sizeof (h),
202 /* alloc chunk size */ 8, "lldp-ethernet");
208 VLIB_INIT_FUNCTION (lldp_template_init);
211 * fd.io coding-style-patch-verification: ON
214 * eval: (c-set-style "gnu")