blob: 550321b3763acdaaeeea89e974b63d94f33d7891 [file] [log] [blame]
Steven9cd2d7a2017-12-20 12:43:01 -08001/*
2 *------------------------------------------------------------------
3 * Copyright (c) 2017 Cisco and/or its affiliates.
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at:
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 *------------------------------------------------------------------
16 */
17
18#define _GNU_SOURCE
19#include <stdint.h>
20#include <vnet/ethernet/ethernet.h>
21#include <vnet/ip/ip4_packet.h>
22#include <vnet/ip/ip6_packet.h>
23#include <vnet/ip/ip6_hop_by_hop_packet.h>
24#include <vnet/bonding/node.h>
Steven0d883012018-05-11 11:06:23 -070025#include <vppinfra/lb_hash_hash.h>
Steven9f781d82018-06-05 11:09:32 -070026#include <vnet/ip/ip.h>
Neale Rannscbe25aa2019-09-30 10:53:31 +000027#include <vnet/ip-neighbor/ip_neighbor.h>
Steven9cd2d7a2017-12-20 12:43:01 -080028
29#define foreach_bond_tx_error \
30 _(NONE, "no error") \
31 _(IF_DOWN, "interface down") \
32 _(NO_SLAVE, "no slave")
33
34typedef enum
35{
36#define _(f,s) BOND_TX_ERROR_##f,
37 foreach_bond_tx_error
38#undef _
39 BOND_TX_N_ERROR,
40} bond_tx_error_t;
41
42static char *bond_tx_error_strings[] = {
43#define _(n,s) s,
44 foreach_bond_tx_error
45#undef _
46};
47
48static u8 *
49format_bond_tx_trace (u8 * s, va_list * args)
50{
51 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
52 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
53 bond_packet_trace_t *t = va_arg (*args, bond_packet_trace_t *);
54 vnet_hw_interface_t *hw, *hw1;
55 vnet_main_t *vnm = vnet_get_main ();
56
57 hw = vnet_get_sup_hw_interface (vnm, t->sw_if_index);
58 hw1 = vnet_get_sup_hw_interface (vnm, t->bond_sw_if_index);
59 s = format (s, "src %U, dst %U, %s -> %s",
60 format_ethernet_address, t->ethernet.src_address,
61 format_ethernet_address, t->ethernet.dst_address,
62 hw->name, hw1->name);
63
64 return s;
65}
66
Damjan Marioncefe1342018-09-21 18:11:33 +020067#ifndef CLIB_MARCH_VARIANT
Steven9cd2d7a2017-12-20 12:43:01 -080068u8 *
69format_bond_interface_name (u8 * s, va_list * args)
70{
71 u32 dev_instance = va_arg (*args, u32);
72 bond_main_t *bm = &bond_main;
73 bond_if_t *bif = pool_elt_at_index (bm->interfaces, dev_instance);
74
Alexander Chernavinad9d5282018-12-13 09:08:09 -050075 s = format (s, "BondEthernet%lu", bif->id);
Steven9cd2d7a2017-12-20 12:43:01 -080076
77 return s;
78}
Damjan Marioncefe1342018-09-21 18:11:33 +020079#endif
Steven9cd2d7a2017-12-20 12:43:01 -080080
81static __clib_unused clib_error_t *
Steven4f8863b2018-04-12 19:36:19 -070082bond_set_l2_mode_function (vnet_main_t * vnm,
83 struct vnet_hw_interface_t *bif_hw,
84 i32 l2_if_adjust)
85{
86 bond_if_t *bif;
87 u32 *sw_if_index;
88 struct vnet_hw_interface_t *sif_hw;
89
90 bif = bond_get_master_by_sw_if_index (bif_hw->sw_if_index);
91 if (!bif)
92 return 0;
93
94 if ((bif_hw->l2_if_count == 1) && (l2_if_adjust == 1))
95 {
96 /* Just added first L2 interface on this port */
97 vec_foreach (sw_if_index, bif->slaves)
98 {
99 sif_hw = vnet_get_sup_hw_interface (vnm, *sw_if_index);
100 ethernet_set_flags (vnm, sif_hw->hw_if_index,
101 ETHERNET_INTERFACE_FLAG_ACCEPT_ALL);
102
103 /* ensure all packets go to ethernet-input */
104 ethernet_set_rx_redirect (vnm, sif_hw, 1);
105 }
106 }
Steven Luonga1f9ee82019-04-09 12:18:46 -0700107 else if ((bif_hw->l2_if_count == 0) && (l2_if_adjust == -1))
108 {
109 /* Just removed last L2 subinterface on this port */
110 vec_foreach (sw_if_index, bif->slaves)
111 {
112 sif_hw = vnet_get_sup_hw_interface (vnm, *sw_if_index);
113
114 /* Allow ip packets to go directly to ip4-input etc */
115 ethernet_set_rx_redirect (vnm, sif_hw, 0);
116 }
117 }
Steven4f8863b2018-04-12 19:36:19 -0700118
119 return 0;
120}
121
122static __clib_unused clib_error_t *
Steven9cd2d7a2017-12-20 12:43:01 -0800123bond_subif_add_del_function (vnet_main_t * vnm, u32 hw_if_index,
124 struct vnet_sw_interface_t *st, int is_add)
125{
126 /* Nothing for now */
127 return 0;
128}
129
130static clib_error_t *
131bond_interface_admin_up_down (vnet_main_t * vnm, u32 hw_if_index, u32 flags)
132{
133 vnet_hw_interface_t *hif = vnet_get_hw_interface (vnm, hw_if_index);
134 uword is_up = (flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) != 0;
135 bond_main_t *bm = &bond_main;
136 bond_if_t *bif = pool_elt_at_index (bm->interfaces, hif->dev_instance);
137
138 bif->admin_up = is_up;
139 if (is_up && vec_len (bif->active_slaves))
140 vnet_hw_interface_set_flags (vnm, bif->hw_if_index,
141 VNET_HW_INTERFACE_FLAG_LINK_UP);
142 return 0;
143}
144
Matthew Smithe83aa452019-11-14 10:36:02 -0600145static clib_error_t *
146bond_add_del_mac_address (vnet_hw_interface_t * hi, const u8 * address,
147 u8 is_add)
148{
149 vnet_main_t *vnm = vnet_get_main ();
150 bond_if_t *bif;
151 clib_error_t *error = 0;
152 vnet_hw_interface_t *s_hi;
153 int i;
154
155
156 bif = bond_get_master_by_sw_if_index (hi->sw_if_index);
157 if (!bif)
158 {
159 return clib_error_return (0, "No bond master found for sw_if_index %u",
160 hi->sw_if_index);
161 }
162
163 /* Add/del address on each slave hw intf, they control the hardware */
164 vec_foreach_index (i, bif->slaves)
165 {
166 s_hi = vnet_get_sup_hw_interface (vnm, vec_elt (bif->slaves, i));
167 error = vnet_hw_interface_add_del_mac_address (vnm, s_hi->hw_if_index,
168 address, is_add);
169
170 if (error)
171 {
172 int j;
173
174 /* undo any that were completed before the failure */
175 for (j = i - 1; j > -1; j--)
176 {
177 s_hi = vnet_get_sup_hw_interface (vnm, vec_elt (bif->slaves, j));
178 vnet_hw_interface_add_del_mac_address (vnm, s_hi->hw_if_index,
179 address, !(is_add));
180 }
181
182 return error;
183 }
184 }
185
186 return 0;
187}
188
Damjan Marion69fdfee2018-10-06 14:33:18 +0200189static_always_inline void
190bond_tx_add_to_queue (bond_per_thread_data_t * ptd, u32 port, u32 bi)
191{
192 u32 idx = ptd->per_port_queue[port].n_buffers++;
193 ptd->per_port_queue[port].buffers[idx] = bi;
194}
195
Steven0d883012018-05-11 11:06:23 -0700196static_always_inline u32
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400197bond_lb_broadcast (vlib_main_t * vm,
Damjan Marion69fdfee2018-10-06 14:33:18 +0200198 bond_if_t * bif, vlib_buffer_t * b0, uword n_slaves)
Steven9cd2d7a2017-12-20 12:43:01 -0800199{
Stevenc4e99c52018-09-27 20:06:26 -0700200 bond_main_t *bm = &bond_main;
Steven9cd2d7a2017-12-20 12:43:01 -0800201 vlib_buffer_t *c0;
Steven22b5be02018-04-11 15:32:15 -0700202 int port;
Steven9cd2d7a2017-12-20 12:43:01 -0800203 u32 sw_if_index;
Damjan Marion067cd622018-07-11 12:47:43 +0200204 u16 thread_index = vm->thread_index;
Stevenc4e99c52018-09-27 20:06:26 -0700205 bond_per_thread_data_t *ptd = vec_elt_at_index (bm->per_thread_data,
206 thread_index);
Steven9cd2d7a2017-12-20 12:43:01 -0800207
Damjan Marion69fdfee2018-10-06 14:33:18 +0200208 for (port = 1; port < n_slaves; port++)
Steven9cd2d7a2017-12-20 12:43:01 -0800209 {
Steven22b5be02018-04-11 15:32:15 -0700210 sw_if_index = *vec_elt_at_index (bif->active_slaves, port);
Steven9cd2d7a2017-12-20 12:43:01 -0800211 c0 = vlib_buffer_copy (vm, b0);
212 if (PREDICT_TRUE (c0 != 0))
213 {
214 vnet_buffer (c0)->sw_if_index[VLIB_TX] = sw_if_index;
Damjan Marion69fdfee2018-10-06 14:33:18 +0200215 bond_tx_add_to_queue (ptd, port, vlib_get_buffer_index (vm, c0));
Steven9cd2d7a2017-12-20 12:43:01 -0800216 }
217 }
218
219 return 0;
220}
221
Steven0d883012018-05-11 11:06:23 -0700222static_always_inline u32
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400223bond_lb_l2 (vlib_buffer_t * b0)
Steven9cd2d7a2017-12-20 12:43:01 -0800224{
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400225 ethernet_header_t *eth = vlib_buffer_get_current (b0);
Steven0d883012018-05-11 11:06:23 -0700226 u64 *dst = (u64 *) & eth->dst_address[0];
227 u64 a = clib_mem_unaligned (dst, u64);
228 u32 *src = (u32 *) & eth->src_address[2];
229 u32 b = clib_mem_unaligned (src, u32);
Steven9cd2d7a2017-12-20 12:43:01 -0800230
Damjan Marion69fdfee2018-10-06 14:33:18 +0200231 return lb_hash_hash_2_tuples (a, b);
Steven9cd2d7a2017-12-20 12:43:01 -0800232}
233
Steven0d883012018-05-11 11:06:23 -0700234static_always_inline u16 *
Steven9cd2d7a2017-12-20 12:43:01 -0800235bond_locate_ethertype (ethernet_header_t * eth)
236{
237 u16 *ethertype_p;
238 ethernet_vlan_header_t *vlan;
239
240 if (!ethernet_frame_is_tagged (clib_net_to_host_u16 (eth->type)))
241 {
242 ethertype_p = &eth->type;
243 }
244 else
245 {
246 vlan = (void *) (eth + 1);
247 ethertype_p = &vlan->type;
248 if (*ethertype_p == ntohs (ETHERNET_TYPE_VLAN))
249 {
250 vlan++;
251 ethertype_p = &vlan->type;
252 }
253 }
254 return ethertype_p;
255}
256
Steven0d883012018-05-11 11:06:23 -0700257static_always_inline u32
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400258bond_lb_l23 (vlib_buffer_t * b0)
Steven9cd2d7a2017-12-20 12:43:01 -0800259{
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400260 ethernet_header_t *eth = vlib_buffer_get_current (b0);
Steven9cd2d7a2017-12-20 12:43:01 -0800261 u8 ip_version;
262 ip4_header_t *ip4;
263 u16 ethertype, *ethertype_p;
Steven0d883012018-05-11 11:06:23 -0700264 u32 *mac1, *mac2, *mac3;
Steven9cd2d7a2017-12-20 12:43:01 -0800265
266 ethertype_p = bond_locate_ethertype (eth);
Steven0d883012018-05-11 11:06:23 -0700267 ethertype = clib_mem_unaligned (ethertype_p, u16);
Steven9cd2d7a2017-12-20 12:43:01 -0800268
269 if ((ethertype != htons (ETHERNET_TYPE_IP4)) &&
270 (ethertype != htons (ETHERNET_TYPE_IP6)))
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400271 return bond_lb_l2 (b0);
Steven9cd2d7a2017-12-20 12:43:01 -0800272
273 ip4 = (ip4_header_t *) (ethertype_p + 1);
274 ip_version = (ip4->ip_version_and_header_length >> 4);
275
276 if (ip_version == 0x4)
277 {
Steven0d883012018-05-11 11:06:23 -0700278 u32 a, c;
Steven9cd2d7a2017-12-20 12:43:01 -0800279
Steven0d883012018-05-11 11:06:23 -0700280 mac1 = (u32 *) & eth->dst_address[0];
281 mac2 = (u32 *) & eth->dst_address[4];
282 mac3 = (u32 *) & eth->src_address[2];
Steven9cd2d7a2017-12-20 12:43:01 -0800283
Steven0d883012018-05-11 11:06:23 -0700284 a = clib_mem_unaligned (mac1, u32) ^ clib_mem_unaligned (mac2, u32) ^
285 clib_mem_unaligned (mac3, u32);
286 c =
287 lb_hash_hash_2_tuples (clib_mem_unaligned (&ip4->address_pair, u64),
288 a);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200289 return c;
Steven9cd2d7a2017-12-20 12:43:01 -0800290 }
291 else if (ip_version == 0x6)
292 {
Steven0d883012018-05-11 11:06:23 -0700293 u64 a;
294 u32 c;
Steven9cd2d7a2017-12-20 12:43:01 -0800295 ip6_header_t *ip6 = (ip6_header_t *) (eth + 1);
296
Steven0d883012018-05-11 11:06:23 -0700297 mac1 = (u32 *) & eth->dst_address[0];
298 mac2 = (u32 *) & eth->dst_address[4];
299 mac3 = (u32 *) & eth->src_address[2];
Steven9cd2d7a2017-12-20 12:43:01 -0800300
Steven0d883012018-05-11 11:06:23 -0700301 a = clib_mem_unaligned (mac1, u32) ^ clib_mem_unaligned (mac2, u32) ^
302 clib_mem_unaligned (mac3, u32);
303 c =
304 lb_hash_hash (clib_mem_unaligned
305 (&ip6->src_address.as_uword[0], uword),
306 clib_mem_unaligned (&ip6->src_address.as_uword[1],
307 uword),
308 clib_mem_unaligned (&ip6->dst_address.as_uword[0],
309 uword),
310 clib_mem_unaligned (&ip6->dst_address.as_uword[1],
311 uword), a);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200312 return c;
Steven9cd2d7a2017-12-20 12:43:01 -0800313 }
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400314 return bond_lb_l2 (b0);
Steven9cd2d7a2017-12-20 12:43:01 -0800315}
316
Steven0d883012018-05-11 11:06:23 -0700317static_always_inline u32
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400318bond_lb_l34 (vlib_buffer_t * b0)
Steven9cd2d7a2017-12-20 12:43:01 -0800319{
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400320 ethernet_header_t *eth = vlib_buffer_get_current (b0);
Steven9cd2d7a2017-12-20 12:43:01 -0800321 u8 ip_version;
Steven0d883012018-05-11 11:06:23 -0700322 uword is_tcp_udp;
Steven9cd2d7a2017-12-20 12:43:01 -0800323 ip4_header_t *ip4;
324 u16 ethertype, *ethertype_p;
325
326 ethertype_p = bond_locate_ethertype (eth);
Steven0d883012018-05-11 11:06:23 -0700327 ethertype = clib_mem_unaligned (ethertype_p, u16);
Steven9cd2d7a2017-12-20 12:43:01 -0800328
329 if ((ethertype != htons (ETHERNET_TYPE_IP4)) &&
330 (ethertype != htons (ETHERNET_TYPE_IP6)))
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400331 return (bond_lb_l2 (b0));
Steven9cd2d7a2017-12-20 12:43:01 -0800332
333 ip4 = (ip4_header_t *) (ethertype_p + 1);
334 ip_version = (ip4->ip_version_and_header_length >> 4);
335
336 if (ip_version == 0x4)
337 {
Damjan Marion69fdfee2018-10-06 14:33:18 +0200338 u32 a, t1, t2;
Steven9cd2d7a2017-12-20 12:43:01 -0800339 tcp_header_t *tcp = (void *) (ip4 + 1);
Steven0d883012018-05-11 11:06:23 -0700340
Steven9cd2d7a2017-12-20 12:43:01 -0800341 is_tcp_udp = (ip4->protocol == IP_PROTOCOL_TCP) ||
342 (ip4->protocol == IP_PROTOCOL_UDP);
Steven0d883012018-05-11 11:06:23 -0700343 t1 = is_tcp_udp ? clib_mem_unaligned (&tcp->src, u16) : 0;
344 t2 = is_tcp_udp ? clib_mem_unaligned (&tcp->dst, u16) : 0;
345 a = t1 ^ t2;
Damjan Marion69fdfee2018-10-06 14:33:18 +0200346 return
Steven0d883012018-05-11 11:06:23 -0700347 lb_hash_hash_2_tuples (clib_mem_unaligned (&ip4->address_pair, u64),
348 a);
Steven9cd2d7a2017-12-20 12:43:01 -0800349 }
350 else if (ip_version == 0x6)
351 {
Steven0d883012018-05-11 11:06:23 -0700352 u64 a;
353 u32 c, t1, t2;
Steven9cd2d7a2017-12-20 12:43:01 -0800354 ip6_header_t *ip6 = (ip6_header_t *) (eth + 1);
355 tcp_header_t *tcp = (void *) (ip6 + 1);
356
Steven0d883012018-05-11 11:06:23 -0700357 is_tcp_udp = 0;
Steven9cd2d7a2017-12-20 12:43:01 -0800358 if (PREDICT_TRUE ((ip6->protocol == IP_PROTOCOL_TCP) ||
359 (ip6->protocol == IP_PROTOCOL_UDP)))
360 {
361 is_tcp_udp = 1;
362 tcp = (void *) (ip6 + 1);
363 }
364 else if (ip6->protocol == IP_PROTOCOL_IP6_HOP_BY_HOP_OPTIONS)
365 {
366 ip6_hop_by_hop_header_t *hbh =
367 (ip6_hop_by_hop_header_t *) (ip6 + 1);
368 if ((hbh->protocol == IP_PROTOCOL_TCP)
369 || (hbh->protocol == IP_PROTOCOL_UDP))
370 {
371 is_tcp_udp = 1;
372 tcp = (tcp_header_t *) ((u8 *) hbh + ((hbh->length + 1) << 3));
373 }
374 }
Steven0d883012018-05-11 11:06:23 -0700375 t1 = is_tcp_udp ? clib_mem_unaligned (&tcp->src, u16) : 0;
376 t2 = is_tcp_udp ? clib_mem_unaligned (&tcp->dst, u16) : 0;
377 a = t1 ^ t2;
378 c =
379 lb_hash_hash (clib_mem_unaligned
380 (&ip6->src_address.as_uword[0], uword),
381 clib_mem_unaligned (&ip6->src_address.as_uword[1],
382 uword),
383 clib_mem_unaligned (&ip6->dst_address.as_uword[0],
384 uword),
385 clib_mem_unaligned (&ip6->dst_address.as_uword[1],
386 uword), a);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200387 return c;
Steven9cd2d7a2017-12-20 12:43:01 -0800388 }
389
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400390 return bond_lb_l2 (b0);
Steven9cd2d7a2017-12-20 12:43:01 -0800391}
392
Steven0d883012018-05-11 11:06:23 -0700393static_always_inline u32
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400394bond_lb_round_robin (bond_if_t * bif, vlib_buffer_t * b0, uword n_slaves)
Steven9cd2d7a2017-12-20 12:43:01 -0800395{
396 bif->lb_rr_last_index++;
Damjan Marion69fdfee2018-10-06 14:33:18 +0200397 if (bif->lb_rr_last_index >= n_slaves)
398 bif->lb_rr_last_index = 0;
Steven9cd2d7a2017-12-20 12:43:01 -0800399
400 return bif->lb_rr_last_index;
401}
402
Damjan Marion16de39e2018-09-26 10:15:41 +0200403static_always_inline void
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400404bond_tx_inline (vlib_main_t * vm, bond_if_t * bif, vlib_buffer_t ** b,
Damjan Marion69fdfee2018-10-06 14:33:18 +0200405 u32 * h, u32 n_left, uword n_slaves, u32 lb_alg)
Steven9cd2d7a2017-12-20 12:43:01 -0800406{
Damjan Marioncefe1342018-09-21 18:11:33 +0200407 while (n_left >= 4)
Steven9cd2d7a2017-12-20 12:43:01 -0800408 {
Damjan Marioncefe1342018-09-21 18:11:33 +0200409 // Prefetch next iteration
410 if (n_left >= 8)
Steven9cd2d7a2017-12-20 12:43:01 -0800411 {
Damjan Marioncefe1342018-09-21 18:11:33 +0200412 vlib_buffer_t **pb = b + 4;
Steven0d883012018-05-11 11:06:23 -0700413
Damjan Marioncefe1342018-09-21 18:11:33 +0200414 vlib_prefetch_buffer_header (pb[0], LOAD);
415 vlib_prefetch_buffer_header (pb[1], LOAD);
416 vlib_prefetch_buffer_header (pb[2], LOAD);
417 vlib_prefetch_buffer_header (pb[3], LOAD);
418
419 CLIB_PREFETCH (pb[0]->data, CLIB_CACHE_LINE_BYTES, LOAD);
420 CLIB_PREFETCH (pb[1]->data, CLIB_CACHE_LINE_BYTES, LOAD);
421 CLIB_PREFETCH (pb[2]->data, CLIB_CACHE_LINE_BYTES, LOAD);
422 CLIB_PREFETCH (pb[3]->data, CLIB_CACHE_LINE_BYTES, LOAD);
423 }
424
425 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[0]);
426 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[1]);
427 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[2]);
428 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[3]);
429
Damjan Marion69fdfee2018-10-06 14:33:18 +0200430 if (lb_alg == BOND_LB_L2)
Damjan Marioncefe1342018-09-21 18:11:33 +0200431 {
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400432 h[0] = bond_lb_l2 (b[0]);
433 h[1] = bond_lb_l2 (b[1]);
434 h[2] = bond_lb_l2 (b[2]);
435 h[3] = bond_lb_l2 (b[3]);
Damjan Marioncefe1342018-09-21 18:11:33 +0200436 }
Damjan Marion69fdfee2018-10-06 14:33:18 +0200437 else if (lb_alg == BOND_LB_L34)
Damjan Marioncefe1342018-09-21 18:11:33 +0200438 {
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400439 h[0] = bond_lb_l34 (b[0]);
440 h[1] = bond_lb_l34 (b[1]);
441 h[2] = bond_lb_l34 (b[2]);
442 h[3] = bond_lb_l34 (b[3]);
Steven9cd2d7a2017-12-20 12:43:01 -0800443 }
Damjan Marion69fdfee2018-10-06 14:33:18 +0200444 else if (lb_alg == BOND_LB_L23)
445 {
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400446 h[0] = bond_lb_l23 (b[0]);
447 h[1] = bond_lb_l23 (b[1]);
448 h[2] = bond_lb_l23 (b[2]);
449 h[3] = bond_lb_l23 (b[3]);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200450 }
451 else if (lb_alg == BOND_LB_RR)
452 {
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400453 h[0] = bond_lb_round_robin (bif, b[0], n_slaves);
454 h[1] = bond_lb_round_robin (bif, b[1], n_slaves);
455 h[2] = bond_lb_round_robin (bif, b[2], n_slaves);
456 h[3] = bond_lb_round_robin (bif, b[3], n_slaves);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200457 }
458 else if (lb_alg == BOND_LB_BC)
459 {
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400460 h[0] = bond_lb_broadcast (vm, bif, b[0], n_slaves);
461 h[1] = bond_lb_broadcast (vm, bif, b[1], n_slaves);
462 h[2] = bond_lb_broadcast (vm, bif, b[2], n_slaves);
463 h[3] = bond_lb_broadcast (vm, bif, b[3], n_slaves);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200464 }
465 else
466 {
467 ASSERT (0);
468 }
Stevenc4e99c52018-09-27 20:06:26 -0700469
Damjan Marioncefe1342018-09-21 18:11:33 +0200470 n_left -= 4;
471 b += 4;
Damjan Marion69fdfee2018-10-06 14:33:18 +0200472 h += 4;
Damjan Marioncefe1342018-09-21 18:11:33 +0200473 }
Steven9cd2d7a2017-12-20 12:43:01 -0800474
Damjan Marioncefe1342018-09-21 18:11:33 +0200475 while (n_left > 0)
476 {
Damjan Marioncefe1342018-09-21 18:11:33 +0200477 VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b[0]);
478
Damjan Marion69fdfee2018-10-06 14:33:18 +0200479 if (bif->lb == BOND_LB_L2)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400480 h[0] = bond_lb_l2 (b[0]);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200481 else if (bif->lb == BOND_LB_L34)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400482 h[0] = bond_lb_l34 (b[0]);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200483 else if (bif->lb == BOND_LB_L23)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400484 h[0] = bond_lb_l23 (b[0]);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200485 else if (bif->lb == BOND_LB_RR)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400486 h[0] = bond_lb_round_robin (bif, b[0], n_slaves);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200487 else if (bif->lb == BOND_LB_BC)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400488 h[0] = bond_lb_broadcast (vm, bif, b[0], n_slaves);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200489 else
Damjan Marion16de39e2018-09-26 10:15:41 +0200490 {
Damjan Marion69fdfee2018-10-06 14:33:18 +0200491 ASSERT (0);
Damjan Marion16de39e2018-09-26 10:15:41 +0200492 }
493
Damjan Marioncefe1342018-09-21 18:11:33 +0200494 n_left -= 1;
495 b += 1;
Steven Luongde0302c2019-10-04 14:18:37 -0700496 h += 1;
Steven9cd2d7a2017-12-20 12:43:01 -0800497 }
Damjan Marion69fdfee2018-10-06 14:33:18 +0200498}
Steven9cd2d7a2017-12-20 12:43:01 -0800499
Damjan Marion69fdfee2018-10-06 14:33:18 +0200500static_always_inline void
501bond_hash_to_port (u32 * h, u32 n_left, u32 n_slaves, int use_modulo_shortcut)
502{
503 u32 mask = n_slaves - 1;
504
505#ifdef CLIB_HAVE_VEC256
Paul Vinciguerra8feeaff2019-03-27 11:25:48 -0700506 /* only lower 16 bits of hash due to single precision fp arithmetic */
Damjan Marion69fdfee2018-10-06 14:33:18 +0200507 u32x8 mask8, sc8u, h8a, h8b;
508 f32x8 sc8f;
509
510 if (use_modulo_shortcut)
Steven9cd2d7a2017-12-20 12:43:01 -0800511 {
Damjan Marion69fdfee2018-10-06 14:33:18 +0200512 mask8 = u32x8_splat (mask);
513 }
514 else
515 {
516 mask8 = u32x8_splat (0xffff);
517 sc8u = u32x8_splat (n_slaves);
518 sc8f = f32x8_from_u32x8 (sc8u);
Steven9cd2d7a2017-12-20 12:43:01 -0800519 }
520
Damjan Marion69fdfee2018-10-06 14:33:18 +0200521 while (n_left > 16)
522 {
523 h8a = u32x8_load_unaligned (h) & mask8;
524 h8b = u32x8_load_unaligned (h + 8) & mask8;
525
526 if (use_modulo_shortcut == 0)
527 {
528 h8a -= sc8u * u32x8_from_f32x8 (f32x8_from_u32x8 (h8a) / sc8f);
529 h8b -= sc8u * u32x8_from_f32x8 (f32x8_from_u32x8 (h8b) / sc8f);
530 }
531
532 u32x8_store_unaligned (h8a, h);
533 u32x8_store_unaligned (h8b, h + 8);
534 n_left -= 16;
535 h += 16;
536 }
537#endif
538
539 while (n_left > 4)
540 {
541 if (use_modulo_shortcut)
542 {
543 h[0] &= mask;
544 h[1] &= mask;
545 h[2] &= mask;
546 h[3] &= mask;
547 }
548 else
549 {
550 h[0] %= n_slaves;
551 h[1] %= n_slaves;
552 h[2] %= n_slaves;
553 h[3] %= n_slaves;
554 }
555 n_left -= 4;
556 h += 4;
557 }
558 while (n_left)
559 {
560 if (use_modulo_shortcut)
561 h[0] &= mask;
562 else
563 h[0] %= n_slaves;
564 n_left -= 1;
565 h += 1;
566 }
567}
568
569static_always_inline void
570bond_update_sw_if_index (bond_per_thread_data_t * ptd, bond_if_t * bif,
571 u32 * bi, vlib_buffer_t ** b, u32 * data, u32 n_left,
572 int single_sw_if_index)
573{
574 u32 sw_if_index = data[0];
575 u32 *h = data;
576
577 while (n_left >= 4)
578 {
579 // Prefetch next iteration
580 if (n_left >= 8)
581 {
582 vlib_buffer_t **pb = b + 4;
583 vlib_prefetch_buffer_header (pb[0], LOAD);
584 vlib_prefetch_buffer_header (pb[1], LOAD);
585 vlib_prefetch_buffer_header (pb[2], LOAD);
586 vlib_prefetch_buffer_header (pb[3], LOAD);
587 }
588
589 if (PREDICT_FALSE (single_sw_if_index))
590 {
591 vnet_buffer (b[0])->sw_if_index[VLIB_TX] = sw_if_index;
592 vnet_buffer (b[1])->sw_if_index[VLIB_TX] = sw_if_index;
593 vnet_buffer (b[2])->sw_if_index[VLIB_TX] = sw_if_index;
594 vnet_buffer (b[3])->sw_if_index[VLIB_TX] = sw_if_index;
595
596 bond_tx_add_to_queue (ptd, 0, bi[0]);
597 bond_tx_add_to_queue (ptd, 0, bi[1]);
598 bond_tx_add_to_queue (ptd, 0, bi[2]);
599 bond_tx_add_to_queue (ptd, 0, bi[3]);
600 }
601 else
602 {
603 u32 sw_if_index[4];
604
605 sw_if_index[0] = *vec_elt_at_index (bif->active_slaves, h[0]);
606 sw_if_index[1] = *vec_elt_at_index (bif->active_slaves, h[1]);
607 sw_if_index[2] = *vec_elt_at_index (bif->active_slaves, h[2]);
608 sw_if_index[3] = *vec_elt_at_index (bif->active_slaves, h[3]);
609
610 vnet_buffer (b[0])->sw_if_index[VLIB_TX] = sw_if_index[0];
611 vnet_buffer (b[1])->sw_if_index[VLIB_TX] = sw_if_index[1];
612 vnet_buffer (b[2])->sw_if_index[VLIB_TX] = sw_if_index[2];
613 vnet_buffer (b[3])->sw_if_index[VLIB_TX] = sw_if_index[3];
614
615 bond_tx_add_to_queue (ptd, h[0], bi[0]);
616 bond_tx_add_to_queue (ptd, h[1], bi[1]);
617 bond_tx_add_to_queue (ptd, h[2], bi[2]);
618 bond_tx_add_to_queue (ptd, h[3], bi[3]);
619 }
620
621 bi += 4;
622 h += 4;
623 b += 4;
624 n_left -= 4;
625 }
626 while (n_left)
627 {
628 if (PREDICT_FALSE (single_sw_if_index))
629 {
630 vnet_buffer (b[0])->sw_if_index[VLIB_TX] = sw_if_index;
631 bond_tx_add_to_queue (ptd, 0, bi[0]);
632 }
633 else
634 {
635 u32 sw_if_index0 = *vec_elt_at_index (bif->active_slaves, h[0]);
636
637 vnet_buffer (b[0])->sw_if_index[VLIB_TX] = sw_if_index0;
638 bond_tx_add_to_queue (ptd, h[0], bi[0]);
639 }
640
641 bi += 1;
642 h += 1;
643 b += 1;
644 n_left -= 1;
645 }
646}
647
648static_always_inline void
649bond_tx_trace (vlib_main_t * vm, vlib_node_runtime_t * node, bond_if_t * bif,
650 vlib_buffer_t ** b, u32 n_left, u32 * h)
651{
652 uword n_trace = vlib_get_trace_count (vm, node);
653
654 while (n_trace > 0 && n_left > 0)
655 {
656 bond_packet_trace_t *t0;
657 ethernet_header_t *eth;
658 u32 next0 = 0;
659
660 vlib_trace_buffer (vm, node, next0, b[0], 0 /* follow_chain */ );
661 vlib_set_trace_count (vm, node, --n_trace);
662 t0 = vlib_add_trace (vm, node, b[0], sizeof (*t0));
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400663 eth = vlib_buffer_get_current (b[0]);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200664 t0->ethernet = *eth;
665 t0->sw_if_index = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
666 if (!h)
667 {
668 t0->bond_sw_if_index = *vec_elt_at_index (bif->active_slaves, 0);
669 }
670 else
671 {
672 t0->bond_sw_if_index = *vec_elt_at_index (bif->active_slaves, h[0]);
673 h++;
674 }
675 b++;
676 n_left--;
677 }
Damjan Marion16de39e2018-09-26 10:15:41 +0200678}
679
680VNET_DEVICE_CLASS_TX_FN (bond_dev_class) (vlib_main_t * vm,
681 vlib_node_runtime_t * node,
682 vlib_frame_t * frame)
683{
684 vnet_interface_output_runtime_t *rund = (void *) node->runtime_data;
685 bond_main_t *bm = &bond_main;
686 u16 thread_index = vm->thread_index;
687 bond_if_t *bif = pool_elt_at_index (bm->interfaces, rund->dev_instance);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200688 uword n_slaves;
689 vlib_buffer_t *bufs[VLIB_FRAME_SIZE];
690 u32 *from = vlib_frame_vector_args (frame);
691 u32 n_left = frame->n_vectors;
692 u32 hashes[VLIB_FRAME_SIZE], *h;
693 vnet_main_t *vnm = vnet_get_main ();
694 bond_per_thread_data_t *ptd = vec_elt_at_index (bm->per_thread_data,
695 thread_index);
696 u32 p, sw_if_index;
Damjan Marion16de39e2018-09-26 10:15:41 +0200697
698 if (PREDICT_FALSE (bif->admin_up == 0))
699 {
Damjan Mariona3d59862018-11-10 10:23:00 +0100700 vlib_buffer_free (vm, vlib_frame_vector_args (frame), frame->n_vectors);
Damjan Marion16de39e2018-09-26 10:15:41 +0200701 vlib_increment_simple_counter (vnet_main.interface_main.sw_if_counters +
702 VNET_INTERFACE_COUNTER_DROP,
703 thread_index, bif->sw_if_index,
704 frame->n_vectors);
705 vlib_error_count (vm, node->node_index, BOND_TX_ERROR_IF_DOWN,
706 frame->n_vectors);
707 return frame->n_vectors;
708 }
709
Damjan Marion69fdfee2018-10-06 14:33:18 +0200710 n_slaves = vec_len (bif->active_slaves);
711 if (PREDICT_FALSE (n_slaves == 0))
Damjan Marion16de39e2018-09-26 10:15:41 +0200712 {
Damjan Mariona3d59862018-11-10 10:23:00 +0100713 vlib_buffer_free (vm, vlib_frame_vector_args (frame), frame->n_vectors);
Damjan Marion16de39e2018-09-26 10:15:41 +0200714 vlib_increment_simple_counter (vnet_main.interface_main.sw_if_counters +
715 VNET_INTERFACE_COUNTER_DROP,
716 thread_index, bif->sw_if_index,
717 frame->n_vectors);
718 vlib_error_count (vm, node->node_index, BOND_TX_ERROR_NO_SLAVE,
719 frame->n_vectors);
720 return frame->n_vectors;
721 }
722
Damjan Marion69fdfee2018-10-06 14:33:18 +0200723 vlib_get_buffers (vm, from, bufs, n_left);
724
Paul Vinciguerra8feeaff2019-03-27 11:25:48 -0700725 /* active-backup mode, ship everything to first sw if index */
Damjan Marion69fdfee2018-10-06 14:33:18 +0200726 if ((bif->lb == BOND_LB_AB) || PREDICT_FALSE (n_slaves == 1))
727 {
728 sw_if_index = *vec_elt_at_index (bif->active_slaves, 0);
729
730 bond_tx_trace (vm, node, bif, bufs, frame->n_vectors, 0);
731 bond_update_sw_if_index (ptd, bif, from, bufs, &sw_if_index, n_left,
732 /* single_sw_if_index */ 1);
733 goto done;
734 }
735
736 if (bif->lb == BOND_LB_BC)
737 {
738 sw_if_index = *vec_elt_at_index (bif->active_slaves, 0);
739
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400740 bond_tx_inline (vm, bif, bufs, hashes, n_left, n_slaves, BOND_LB_BC);
Damjan Marion69fdfee2018-10-06 14:33:18 +0200741 bond_tx_trace (vm, node, bif, bufs, frame->n_vectors, 0);
742 bond_update_sw_if_index (ptd, bif, from, bufs, &sw_if_index, n_left,
743 /* single_sw_if_index */ 1);
744 goto done;
745 }
746
Zhiyong Yang751e3f32019-06-26 05:49:14 -0400747 /* if have at least one slave on local numa node, only slaves on local numa
748 node will transmit pkts when bif->local_numa_only is enabled */
749 if (bif->n_numa_slaves >= 1)
750 n_slaves = bif->n_numa_slaves;
751
Damjan Marion16de39e2018-09-26 10:15:41 +0200752 if (bif->lb == BOND_LB_L2)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400753 bond_tx_inline (vm, bif, bufs, hashes, n_left, n_slaves, BOND_LB_L2);
Damjan Marion16de39e2018-09-26 10:15:41 +0200754 else if (bif->lb == BOND_LB_L34)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400755 bond_tx_inline (vm, bif, bufs, hashes, n_left, n_slaves, BOND_LB_L34);
Damjan Marion16de39e2018-09-26 10:15:41 +0200756 else if (bif->lb == BOND_LB_L23)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400757 bond_tx_inline (vm, bif, bufs, hashes, n_left, n_slaves, BOND_LB_L23);
Damjan Marion16de39e2018-09-26 10:15:41 +0200758 else if (bif->lb == BOND_LB_RR)
Zhiyong Yangb388e1a2019-05-08 22:57:53 -0400759 bond_tx_inline (vm, bif, bufs, hashes, n_left, n_slaves, BOND_LB_RR);
Damjan Marion16de39e2018-09-26 10:15:41 +0200760 else
761 ASSERT (0);
Steven9cd2d7a2017-12-20 12:43:01 -0800762
Damjan Marion69fdfee2018-10-06 14:33:18 +0200763 /* calculate port out of hash */
764 h = hashes;
765 if (BOND_MODULO_SHORTCUT (n_slaves))
766 bond_hash_to_port (h, frame->n_vectors, n_slaves, 1);
767 else
768 bond_hash_to_port (h, frame->n_vectors, n_slaves, 0);
769
770 bond_tx_trace (vm, node, bif, bufs, frame->n_vectors, h);
771
772 bond_update_sw_if_index (ptd, bif, from, bufs, hashes, frame->n_vectors,
773 /* single_sw_if_index */ 0);
774
775done:
776 for (p = 0; p < n_slaves; p++)
777 {
778 vlib_frame_t *f;
779 u32 *to_next;
780
781 sw_if_index = *vec_elt_at_index (bif->active_slaves, p);
782 if (PREDICT_TRUE (ptd->per_port_queue[p].n_buffers))
783 {
784 f = vnet_get_frame_to_sw_interface (vnm, sw_if_index);
785 f->n_vectors = ptd->per_port_queue[p].n_buffers;
786 to_next = vlib_frame_vector_args (f);
Dave Barach178cf492018-11-13 16:34:13 -0500787 clib_memcpy_fast (to_next, ptd->per_port_queue[p].buffers,
788 f->n_vectors * sizeof (u32));
Damjan Marion69fdfee2018-10-06 14:33:18 +0200789 vnet_put_frame_to_sw_interface (vnm, sw_if_index, f);
790 ptd->per_port_queue[p].n_buffers = 0;
791 }
792 }
Steven9cd2d7a2017-12-20 12:43:01 -0800793 return frame->n_vectors;
794}
795
Steven9f781d82018-06-05 11:09:32 -0700796static walk_rc_t
797bond_active_interface_switch_cb (vnet_main_t * vnm, u32 sw_if_index,
798 void *arg)
799{
800 bond_main_t *bm = &bond_main;
801
Neale Rannscbe25aa2019-09-30 10:53:31 +0000802 ip_neighbor_advertise (bm->vlib_main, IP46_TYPE_BOTH, NULL, sw_if_index);
Steven9f781d82018-06-05 11:09:32 -0700803
804 return (WALK_CONTINUE);
805}
806
807static uword
808bond_process (vlib_main_t * vm, vlib_node_runtime_t * rt, vlib_frame_t * f)
809{
810 vnet_main_t *vnm = vnet_get_main ();
811 uword event_type, *event_data = 0;
812
813 while (1)
814 {
815 u32 i;
816 u32 hw_if_index;
817
818 vlib_process_wait_for_event (vm);
819 event_type = vlib_process_get_events (vm, &event_data);
820 ASSERT (event_type == BOND_SEND_GARP_NA);
821 for (i = 0; i < vec_len (event_data); i++)
822 {
823 hw_if_index = event_data[i];
Steven Luongbac326c2019-08-05 09:47:58 -0700824 if (vnet_get_hw_interface_or_null (vnm, hw_if_index))
825 /* walk hw interface to process all subinterfaces */
826 vnet_hw_interface_walk_sw (vnm, hw_if_index,
827 bond_active_interface_switch_cb, 0);
Steven9f781d82018-06-05 11:09:32 -0700828 }
829 vec_reset_length (event_data);
830 }
831 return 0;
832}
833
834/* *INDENT-OFF* */
835VLIB_REGISTER_NODE (bond_process_node) = {
836 .function = bond_process,
Damjan Marion7ca5aaa2019-09-24 18:10:49 +0200837 .flags = VLIB_NODE_FLAG_TRACE_SUPPORTED,
Steven9f781d82018-06-05 11:09:32 -0700838 .type = VLIB_NODE_TYPE_PROCESS,
839 .name = "bond-process",
840};
841/* *INDENT-ON* */
842
Steven9cd2d7a2017-12-20 12:43:01 -0800843/* *INDENT-OFF* */
844VNET_DEVICE_CLASS (bond_dev_class) = {
845 .name = "bond",
Steven9cd2d7a2017-12-20 12:43:01 -0800846 .tx_function_n_errors = BOND_TX_N_ERROR,
847 .tx_function_error_strings = bond_tx_error_strings,
848 .format_device_name = format_bond_interface_name,
Steven4f8863b2018-04-12 19:36:19 -0700849 .set_l2_mode_function = bond_set_l2_mode_function,
Steven9cd2d7a2017-12-20 12:43:01 -0800850 .admin_up_down_function = bond_interface_admin_up_down,
851 .subif_add_del_function = bond_subif_add_del_function,
852 .format_tx_trace = format_bond_tx_trace,
Matthew Smithe83aa452019-11-14 10:36:02 -0600853 .mac_addr_add_del_function = bond_add_del_mac_address,
Steven9cd2d7a2017-12-20 12:43:01 -0800854};
855
Steven9cd2d7a2017-12-20 12:43:01 -0800856/* *INDENT-ON* */
857
Steven Luongbac326c2019-08-05 09:47:58 -0700858static clib_error_t *
859bond_slave_interface_add_del (vnet_main_t * vnm, u32 sw_if_index, u32 is_add)
860{
861 bond_main_t *bm = &bond_main;
862 slave_if_t *sif;
863 bond_detach_slave_args_t args = { 0 };
864
865 if (is_add)
866 return 0;
867 sif = bond_get_slave_by_sw_if_index (sw_if_index);
868 if (!sif)
869 return 0;
870 args.slave = sw_if_index;
871 bond_detach_slave (bm->vlib_main, &args);
872 return args.error;
873}
874
875VNET_SW_INTERFACE_ADD_DEL_FUNCTION (bond_slave_interface_add_del);
876
Steven9cd2d7a2017-12-20 12:43:01 -0800877/*
878 * fd.io coding-style-patch-verification: ON
879 *
880 * Local Variables:
881 * eval: (c-set-style "gnu")
882 * End:
883 */