Fix sending GARP/NA on Bonded Interface Active/Backup Link Up/Down
[vpp.git] / src / plugins / dpdk / device / common.c
1 /*
2  * Copyright (c) 2017 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:
6  *
7  *     http://www.apache.org/licenses/LICENSE-2.0
8  *
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.
14  */
15
16 #include <vnet/vnet.h>
17 #include <vppinfra/vec.h>
18 #include <vppinfra/format.h>
19 #include <vlib/unix/cj.h>
20 #include <assert.h>
21
22 #include <vnet/ip/ip.h>
23 #include <vnet/ethernet/ethernet.h>
24 #include <vnet/ethernet/arp_packet.h>
25 #include <dpdk/device/dpdk.h>
26
27 #include <dpdk/device/dpdk_priv.h>
28 #include <vppinfra/error.h>
29
30 void
31 dpdk_device_error (dpdk_device_t * xd, char *str, int rv)
32 {
33   xd->errors = clib_error_return (xd->errors, "%s[port:%d, errno:%d]: %s",
34                                   str, xd->device_index, rv,
35                                   rte_strerror (rv));
36 }
37
38 void
39 dpdk_device_setup (dpdk_device_t * xd)
40 {
41   dpdk_main_t *dm = &dpdk_main;
42   vnet_main_t *vnm = vnet_get_main ();
43   vnet_sw_interface_t *sw = vnet_get_sw_interface (vnm, xd->vlib_sw_if_index);
44   int rv;
45   int j;
46
47   ASSERT (vlib_get_thread_index () == 0);
48
49   clib_error_free (xd->errors);
50   sw->flags &= ~VNET_SW_INTERFACE_FLAG_ERROR;
51
52   if (xd->flags & DPDK_DEVICE_FLAG_ADMIN_UP)
53     {
54       vnet_hw_interface_set_flags (dm->vnet_main, xd->hw_if_index, 0);
55       dpdk_device_stop (xd);
56     }
57
58   rv = rte_eth_dev_configure (xd->device_index, xd->rx_q_used,
59                               xd->tx_q_used, &xd->port_conf);
60
61   if (rv < 0)
62     {
63       dpdk_device_error (xd, "rte_eth_dev_configure", rv);
64       goto error;
65     }
66
67   /* Set up one TX-queue per worker thread */
68   for (j = 0; j < xd->tx_q_used; j++)
69     {
70       rv = rte_eth_tx_queue_setup (xd->device_index, j, xd->nb_tx_desc,
71                                    xd->cpu_socket, &xd->tx_conf);
72
73       /* retry with any other CPU socket */
74       if (rv < 0)
75         rv = rte_eth_tx_queue_setup (xd->device_index, j, xd->nb_tx_desc,
76                                      SOCKET_ID_ANY, &xd->tx_conf);
77       if (rv < 0)
78         dpdk_device_error (xd, "rte_eth_tx_queue_setup", rv);
79     }
80
81   for (j = 0; j < xd->rx_q_used; j++)
82     {
83       uword tidx = vnet_get_device_input_thread_index (dm->vnet_main,
84                                                        xd->hw_if_index, j);
85       unsigned lcore = vlib_worker_threads[tidx].lcore_id;
86       u16 socket_id = rte_lcore_to_socket_id (lcore);
87
88       rv = rte_eth_rx_queue_setup (xd->device_index, j, xd->nb_rx_desc,
89                                    xd->cpu_socket, 0,
90                                    dm->pktmbuf_pools[socket_id]);
91
92       /* retry with any other CPU socket */
93       if (rv < 0)
94         rv = rte_eth_rx_queue_setup (xd->device_index, j, xd->nb_rx_desc,
95                                      SOCKET_ID_ANY, 0,
96                                      dm->pktmbuf_pools[socket_id]);
97
98       if (rv < 0)
99         dpdk_device_error (xd, "rte_eth_rx_queue_setup", rv);
100     }
101
102   if (vec_len (xd->errors))
103     goto error;
104
105   if (xd->flags & DPDK_DEVICE_FLAG_ADMIN_UP)
106     dpdk_device_start (xd);
107
108   if (vec_len (xd->errors))
109     goto error;
110
111   return;
112
113 error:
114   xd->flags |= DPDK_DEVICE_FLAG_PMD_INIT_FAIL;
115   sw->flags |= VNET_SW_INTERFACE_FLAG_ERROR;
116 }
117
118 void
119 dpdk_device_start (dpdk_device_t * xd)
120 {
121   int rv;
122
123   if (xd->flags & DPDK_DEVICE_FLAG_PMD_INIT_FAIL)
124     return;
125
126   rv = rte_eth_dev_start (xd->device_index);
127
128   if (rv)
129     {
130       dpdk_device_error (xd, "rte_eth_dev_start", rv);
131       return;
132     }
133
134   if (xd->default_mac_address)
135     rv =
136       rte_eth_dev_default_mac_addr_set (xd->device_index,
137                                         (struct ether_addr *)
138                                         xd->default_mac_address);
139
140   if (rv)
141     dpdk_device_error (xd, "rte_eth_dev_default_mac_addr_set", rv);
142
143   if (xd->flags & DPDK_DEVICE_FLAG_PROMISC)
144     rte_eth_promiscuous_enable (xd->device_index);
145   else
146     rte_eth_promiscuous_disable (xd->device_index);
147
148   rte_eth_allmulticast_enable (xd->device_index);
149
150   if (xd->pmd == VNET_DPDK_PMD_BOND)
151     {
152       u8 slink[16];
153       int nlink = rte_eth_bond_slaves_get (xd->device_index, slink, 16);
154       while (nlink >= 1)
155         {
156           u8 dpdk_port = slink[--nlink];
157           rte_eth_allmulticast_enable (dpdk_port);
158         }
159     }
160 }
161
162 void
163 dpdk_device_stop (dpdk_device_t * xd)
164 {
165   if (xd->flags & DPDK_DEVICE_FLAG_PMD_INIT_FAIL)
166     return;
167
168   rte_eth_allmulticast_disable (xd->device_index);
169   rte_eth_dev_stop (xd->device_index);
170
171   /* For bonded interface, stop slave links */
172   if (xd->pmd == VNET_DPDK_PMD_BOND)
173     {
174       u8 slink[16];
175       int nlink = rte_eth_bond_slaves_get (xd->device_index, slink, 16);
176       while (nlink >= 1)
177         {
178           u8 dpdk_port = slink[--nlink];
179           rte_eth_dev_stop (dpdk_port);
180         }
181     }
182 }
183
184 /* Even type for send_garp_na_process */
185 enum
186 {
187   SEND_GARP_NA = 1,
188 } dpdk_send_garp_na_process_event_t;
189
190 static vlib_node_registration_t send_garp_na_proc_node;
191
192 static uword
193 send_garp_na_process (vlib_main_t * vm,
194                       vlib_node_runtime_t * rt, vlib_frame_t * f)
195 {
196   vnet_main_t *vnm = vnet_get_main ();
197   uword event_type, *event_data = 0;
198
199   while (1)
200     {
201       u32 i;
202       uword dpdk_port;
203       vlib_process_wait_for_event (vm);
204       event_type = vlib_process_get_events (vm, &event_data);
205       ASSERT (event_type == SEND_GARP_NA);
206       for (i = 0; i < vec_len (event_data); i++)
207         {
208           dpdk_port = event_data[i];
209           if (i < 5)            /* wait 0.2 sec for link to settle, max total 1 sec */
210             vlib_process_suspend (vm, 0.2);
211           dpdk_device_t *xd = &dpdk_main.devices[dpdk_port];
212           u32 hw_if_index = xd->hw_if_index;
213           vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index);
214           dpdk_update_link_state (xd, vlib_time_now (vm));
215           send_ip4_garp (vm, hi);
216           send_ip6_na (vm, hi);
217         }
218       vec_reset_length (event_data);
219     }
220   return 0;
221 }
222
223 /* *INDENT-OFF* */
224 VLIB_REGISTER_NODE (send_garp_na_proc_node, static) = {
225     .function = send_garp_na_process,
226     .type = VLIB_NODE_TYPE_PROCESS,
227     .name = "send-garp-na-process",
228 };
229 /* *INDENT-ON* */
230
231 void vl_api_force_rpc_call_main_thread (void *fp, u8 * data, u32 data_length);
232
233 static void
234 garp_na_proc_callback (uword * dpdk_port)
235 {
236   vlib_main_t *vm = vlib_get_main ();
237   ASSERT (vlib_get_thread_index () == 0);
238   vlib_process_signal_event
239     (vm, send_garp_na_proc_node.index, SEND_GARP_NA, *dpdk_port);
240 }
241
242 always_inline int
243 dpdk_port_state_callback_inline (uint8_t port_id,
244                                  enum rte_eth_event_type type, void *param)
245 {
246   struct rte_eth_link link;
247   dpdk_device_t *xd = &dpdk_main.devices[port_id];
248
249   RTE_SET_USED (param);
250   if (type != RTE_ETH_EVENT_INTR_LSC)
251     {
252       clib_warning ("Unknown event %d received for port %d", type, port_id);
253       return -1;
254     }
255
256   rte_eth_link_get_nowait (port_id, &link);
257   u8 link_up = link.link_status;
258
259   if (xd->flags & DPDK_DEVICE_FLAG_BOND_SLAVE)
260     {
261       uword bd_port = xd->bond_port;
262       int bd_mode = rte_eth_bond_mode_get (bd_port);
263 #if 0
264       clib_warning ("Port %d state to %s, "
265                     "slave of port %d BondEthernet%d in mode %d",
266                     port_id, (link_up) ? "UP" : "DOWN",
267                     bd_port, xd->port_id, bd_mode);
268 #endif
269       if (bd_mode == BONDING_MODE_ACTIVE_BACKUP)
270         {
271           vl_api_force_rpc_call_main_thread
272             (garp_na_proc_callback, (u8 *) & bd_port, sizeof (uword));
273         }
274       xd->flags |= link_up ?
275         DPDK_DEVICE_FLAG_BOND_SLAVE_UP : ~DPDK_DEVICE_FLAG_BOND_SLAVE_UP;
276     }
277   else                          /* Should not happen as callback not setup for "normal" links */
278     {
279       if (link_up)
280         clib_warning ("Port %d Link Up - speed %u Mbps - %s",
281                       port_id, (unsigned) link.link_speed,
282                       (link.link_duplex == ETH_LINK_FULL_DUPLEX) ?
283                       "full-duplex" : "half-duplex");
284       else
285         clib_warning ("Port %d Link Down\n\n", port_id);
286     }
287
288   return 0;
289 }
290
291 #if DPDK_VOID_CALLBACK
292 void
293 dpdk_port_state_callback (uint8_t port_id,
294                           enum rte_eth_event_type type, void *param)
295 {
296   dpdk_port_state_callback_inline (port_id, type, param);
297 }
298
299 #else
300 int
301 dpdk_port_state_callback (uint8_t port_id,
302                           enum rte_eth_event_type type,
303                           void *param,
304                           void *ret_param __attribute__ ((unused)))
305 {
306   return dpdk_port_state_callback_inline (port_id, type, param);
307 }
308 #endif
309 /*
310  * fd.io coding-style-patch-verification: ON
311  *
312  * Local Variables:
313  * eval: (c-set-style "gnu")
314  * End:
315  */