interface: add capabilities flags
[vpp.git] / src / plugins / af_xdp / device.c
1 /*
2  *------------------------------------------------------------------
3  * Copyright (c) 2018 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 #include <stdio.h>
19 #include <net/if.h>
20 #include <linux/if_link.h>
21 #include <bpf/libbpf.h>
22 #include <vlib/vlib.h>
23 #include <vlib/unix/unix.h>
24 #include <vlib/pci/pci.h>
25 #include <vppinfra/linux/sysfs.h>
26 #include <vppinfra/unix.h>
27 #include <vnet/ethernet/ethernet.h>
28 #include <vnet/interface/rx_queue_funcs.h>
29 #include "af_xdp.h"
30
31 af_xdp_main_t af_xdp_main;
32
33 typedef struct
34 {
35   u32 prod;
36   u32 cons;
37 } gdb_af_xdp_pair_t;
38
39 gdb_af_xdp_pair_t
40 gdb_af_xdp_get_prod (const struct xsk_ring_prod *prod)
41 {
42   gdb_af_xdp_pair_t pair = { *prod->producer, *prod->consumer };
43   return pair;
44 }
45
46 gdb_af_xdp_pair_t
47 gdb_af_xdp_get_cons (const struct xsk_ring_cons * cons)
48 {
49   gdb_af_xdp_pair_t pair = { *cons->producer, *cons->consumer };
50   return pair;
51 }
52
53 static clib_error_t *
54 af_xdp_mac_change (vnet_hw_interface_t * hw, const u8 * old, const u8 * new)
55 {
56   af_xdp_main_t *am = &af_xdp_main;
57   af_xdp_device_t *ad = vec_elt_at_index (am->devices, hw->dev_instance);
58   errno_t err = memcpy_s (ad->hwaddr, sizeof (ad->hwaddr), new, 6);
59   if (err)
60     return clib_error_return_code (0, -err, CLIB_ERROR_ERRNO_VALID,
61                                    "mac change failed");
62   return 0;
63 }
64
65 static u32
66 af_xdp_flag_change (vnet_main_t * vnm, vnet_hw_interface_t * hw, u32 flags)
67 {
68   af_xdp_main_t *am = &af_xdp_main;
69   af_xdp_device_t *ad = vec_elt_at_index (am->devices, hw->dev_instance);
70
71   switch (flags)
72     {
73     case 0:
74       af_xdp_log (VLIB_LOG_LEVEL_ERR, ad, "set unicast not supported yet");
75       return ~0;
76     case ETHERNET_INTERFACE_FLAG_ACCEPT_ALL:
77       af_xdp_log (VLIB_LOG_LEVEL_ERR, ad,
78                   "set promiscuous not supported yet");
79       return ~0;
80     case ETHERNET_INTERFACE_FLAG_MTU:
81       af_xdp_log (VLIB_LOG_LEVEL_ERR, ad, "set mtu not supported yet");
82       return ~0;
83     }
84
85   af_xdp_log (VLIB_LOG_LEVEL_ERR, ad, "unknown flag %x requested", flags);
86   return ~0;
87 }
88
89 void
90 af_xdp_delete_if (vlib_main_t * vm, af_xdp_device_t * ad)
91 {
92   vnet_main_t *vnm = vnet_get_main ();
93   af_xdp_main_t *axm = &af_xdp_main;
94   struct xsk_socket **xsk;
95   struct xsk_umem **umem;
96   af_xdp_rxq_t *rxq;
97   af_xdp_txq_t *txq;
98
99   if (ad->hw_if_index)
100     {
101       vnet_hw_interface_set_flags (vnm, ad->hw_if_index, 0);
102       ethernet_delete_interface (vnm, ad->hw_if_index);
103     }
104
105   vec_foreach (rxq, ad->rxqs) clib_file_del_by_index (&file_main,
106                                                       rxq->file_index);
107   vec_foreach (txq, ad->txqs) clib_spinlock_free (&txq->lock);
108   vec_foreach (xsk, ad->xsk) xsk_socket__delete (*xsk);
109   vec_foreach (umem, ad->umem) xsk_umem__delete (*umem);
110
111   if (ad->bpf_obj)
112     {
113       bpf_set_link_xdp_fd (ad->linux_ifindex, -1, 0);
114       bpf_object__unload (ad->bpf_obj);
115     }
116
117   vec_free (ad->xsk);
118   vec_free (ad->umem);
119   vec_free (ad->buffer_template);
120   vec_free (ad->rxqs);
121   vec_free (ad->txqs);
122   clib_error_free (ad->error);
123   pool_put (axm->devices, ad);
124 }
125
126 static int
127 af_xdp_load_program (af_xdp_create_if_args_t * args, af_xdp_device_t * ad)
128 {
129   int fd;
130
131   ad->linux_ifindex = if_nametoindex (ad->linux_ifname);
132   if (!ad->linux_ifindex)
133     {
134       args->rv = VNET_API_ERROR_INVALID_VALUE;
135       args->error =
136         clib_error_return_unix (0, "if_nametoindex(%s) failed",
137                                 ad->linux_ifname);
138       goto err0;
139     }
140
141   if (bpf_prog_load (args->prog, BPF_PROG_TYPE_XDP, &ad->bpf_obj, &fd))
142     {
143       args->rv = VNET_API_ERROR_SYSCALL_ERROR_5;
144       args->error =
145         clib_error_return_unix (0, "bpf_prog_load(%s) failed", args->prog);
146       goto err0;
147     }
148
149 #ifndef XDP_FLAGS_REPLACE
150 #define XDP_FLAGS_REPLACE 0
151 #endif
152   if (bpf_set_link_xdp_fd (ad->linux_ifindex, fd, XDP_FLAGS_REPLACE))
153     {
154       args->rv = VNET_API_ERROR_SYSCALL_ERROR_6;
155       args->error =
156         clib_error_return_unix (0, "bpf_set_link_xdp_fd(%s) failed",
157                                 ad->linux_ifname);
158       goto err1;
159     }
160
161   return 0;
162
163 err1:
164   bpf_object__unload (ad->bpf_obj);
165   ad->bpf_obj = 0;
166 err0:
167   ad->linux_ifindex = ~0;
168   return -1;
169 }
170
171 static int
172 af_xdp_create_queue (vlib_main_t * vm, af_xdp_create_if_args_t * args,
173                      af_xdp_device_t * ad, int qid, int rxq_num, int txq_num)
174 {
175   struct xsk_umem **umem;
176   struct xsk_socket **xsk;
177   af_xdp_rxq_t *rxq;
178   af_xdp_txq_t *txq;
179   struct xsk_umem_config umem_config;
180   struct xsk_socket_config sock_config;
181   struct xdp_options opt;
182   socklen_t optlen;
183
184   vec_validate_aligned (ad->umem, qid, CLIB_CACHE_LINE_BYTES);
185   umem = vec_elt_at_index (ad->umem, qid);
186
187   vec_validate_aligned (ad->xsk, qid, CLIB_CACHE_LINE_BYTES);
188   xsk = vec_elt_at_index (ad->xsk, qid);
189
190   vec_validate_aligned (ad->rxqs, qid, CLIB_CACHE_LINE_BYTES);
191   rxq = vec_elt_at_index (ad->rxqs, qid);
192
193   vec_validate_aligned (ad->txqs, qid, CLIB_CACHE_LINE_BYTES);
194   txq = vec_elt_at_index (ad->txqs, qid);
195
196   /*
197    * fq and cq must always be allocated even if unused
198    * whereas rx and tx indicates whether we want rxq, txq, or both
199    */
200   struct xsk_ring_cons *rx = qid < rxq_num ? &rxq->rx : 0;
201   struct xsk_ring_prod *fq = &rxq->fq;
202   struct xsk_ring_prod *tx = qid < txq_num ? &txq->tx : 0;
203   struct xsk_ring_cons *cq = &txq->cq;
204   int fd;
205
206   memset (&umem_config, 0, sizeof (umem_config));
207   umem_config.fill_size = args->rxq_size;
208   umem_config.comp_size = args->txq_size;
209   umem_config.frame_size =
210     sizeof (vlib_buffer_t) + vlib_buffer_get_default_data_size (vm);
211   umem_config.flags = XDP_UMEM_UNALIGNED_CHUNK_FLAG;
212   if (xsk_umem__create
213       (umem, uword_to_pointer (vm->buffer_main->buffer_mem_start, void *),
214        vm->buffer_main->buffer_mem_size, fq, cq, &umem_config))
215     {
216       args->rv = VNET_API_ERROR_SYSCALL_ERROR_1;
217       args->error = clib_error_return_unix (0, "xsk_umem__create() failed");
218       goto err0;
219     }
220
221   memset (&sock_config, 0, sizeof (sock_config));
222   sock_config.rx_size = args->rxq_size;
223   sock_config.tx_size = args->txq_size;
224   sock_config.bind_flags = XDP_USE_NEED_WAKEUP;
225   switch (args->mode)
226     {
227     case AF_XDP_MODE_AUTO:
228       break;
229     case AF_XDP_MODE_COPY:
230       sock_config.bind_flags |= XDP_COPY;
231       break;
232     case AF_XDP_MODE_ZERO_COPY:
233       sock_config.bind_flags |= XDP_ZEROCOPY;
234       break;
235     }
236   if (xsk_socket__create
237       (xsk, ad->linux_ifname, qid, *umem, rx, tx, &sock_config))
238     {
239       args->rv = VNET_API_ERROR_SYSCALL_ERROR_2;
240       args->error =
241         clib_error_return_unix (0,
242                                 "xsk_socket__create() failed (is linux netdev %s up?)",
243                                 ad->linux_ifname);
244       goto err1;
245     }
246
247   fd = xsk_socket__fd (*xsk);
248   optlen = sizeof (opt);
249   if (getsockopt (fd, SOL_XDP, XDP_OPTIONS, &opt, &optlen))
250     {
251       args->rv = VNET_API_ERROR_SYSCALL_ERROR_3;
252       args->error =
253         clib_error_return_unix (0, "getsockopt(XDP_OPTIONS) failed");
254       goto err2;
255     }
256   if (opt.flags & XDP_OPTIONS_ZEROCOPY)
257     ad->flags |= AF_XDP_DEVICE_F_ZEROCOPY;
258
259   rxq->xsk_fd = qid < rxq_num ? fd : -1;
260   txq->xsk_fd = qid < txq_num ? fd : -1;
261
262   return 0;
263
264 err2:
265   xsk_socket__delete (*xsk);
266 err1:
267   xsk_umem__delete (*umem);
268 err0:
269   *umem = 0;
270   *xsk = 0;
271   return -1;
272 }
273
274 static int
275 af_xdp_get_numa (const char *ifname)
276 {
277   char *path;
278   clib_error_t *err;
279   int numa;
280
281   path =
282     (char *) format (0, "/sys/class/net/%s/device/numa_node%c", ifname, 0);
283   err = clib_sysfs_read (path, "%d", &numa);
284   if (err || numa < 0)
285     numa = 0;
286
287   clib_error_free (err);
288   vec_free (path);
289   return numa;
290 }
291
292 static clib_error_t *
293 af_xdp_device_rxq_read_ready (clib_file_t * f)
294 {
295   vnet_hw_if_rx_queue_set_int_pending (vnet_get_main (), f->private_data);
296   return 0;
297 }
298
299 static void
300 af_xdp_device_set_rxq_mode (af_xdp_rxq_t *rxq, int is_polling)
301 {
302   clib_file_main_t *fm = &file_main;
303   clib_file_t *f;
304
305   if (rxq->is_polling == is_polling)
306     return;
307
308   f = clib_file_get (fm, rxq->file_index);
309   fm->file_update (f, is_polling ? UNIX_FILE_UPDATE_DELETE :
310                                    UNIX_FILE_UPDATE_ADD);
311   rxq->is_polling = !!is_polling;
312 }
313
314 void
315 af_xdp_create_if (vlib_main_t * vm, af_xdp_create_if_args_t * args)
316 {
317   vnet_main_t *vnm = vnet_get_main ();
318   vlib_thread_main_t *tm = vlib_get_thread_main ();
319   af_xdp_main_t *am = &af_xdp_main;
320   af_xdp_device_t *ad;
321   vnet_sw_interface_t *sw;
322   vnet_hw_interface_t *hw;
323   int rxq_num, txq_num, q_num;
324   int i;
325
326   args->rxq_size = args->rxq_size ? args->rxq_size : 2 * VLIB_FRAME_SIZE;
327   args->txq_size = args->txq_size ? args->txq_size : 2 * VLIB_FRAME_SIZE;
328   rxq_num = args->rxq_num ? args->rxq_num : 1;
329   txq_num = tm->n_vlib_mains;
330
331   if (!args->linux_ifname)
332     {
333       args->rv = VNET_API_ERROR_INVALID_VALUE;
334       args->error = clib_error_return (0, "missing host interface");
335       goto err0;
336     }
337
338   if (args->rxq_size < VLIB_FRAME_SIZE || args->txq_size < VLIB_FRAME_SIZE ||
339       args->rxq_size > 65535 || args->txq_size > 65535 ||
340       !is_pow2 (args->rxq_size) || !is_pow2 (args->txq_size))
341     {
342       args->rv = VNET_API_ERROR_INVALID_VALUE;
343       args->error =
344         clib_error_return (0,
345                            "queue size must be a power of two between %i and 65535",
346                            VLIB_FRAME_SIZE);
347       goto err0;
348     }
349
350   pool_get_zero (am->devices, ad);
351
352   ad->linux_ifname = (char *) format (0, "%s", args->linux_ifname);
353   vec_validate (ad->linux_ifname, IFNAMSIZ - 1);        /* libbpf expects ifname to be at least IFNAMSIZ */
354
355   if (args->prog && af_xdp_load_program (args, ad))
356     goto err1;
357
358   q_num = clib_max (rxq_num, txq_num);
359   ad->txq_num = txq_num;
360   for (i = 0; i < q_num; i++)
361     {
362       if (af_xdp_create_queue (vm, args, ad, i, rxq_num, txq_num))
363         {
364           /*
365            * queue creation failed
366            * it is only a fatal error if we could not create the number of rx
367            * queues requested explicitely by the user and the user did not
368            * requested 'max'
369            * we might create less tx queues than workers but this is ok
370            */
371
372           /* fixup vectors length */
373           vec_set_len (ad->umem, i);
374           vec_set_len (ad->xsk, i);
375           vec_set_len (ad->rxqs, i);
376           vec_set_len (ad->txqs, i);
377
378           if (i < rxq_num && AF_XDP_NUM_RX_QUEUES_ALL != rxq_num)
379             goto err1;          /* failed creating requested rxq: fatal error, bailing out */
380
381           if (i < txq_num)
382             {
383               /* we created less txq than threads not an error but initialize lock for shared txq */
384               af_xdp_txq_t *txq;
385               ad->txq_num = i;
386               vec_foreach (txq, ad->txqs) clib_spinlock_init (&txq->lock);
387             }
388
389           args->rv = 0;
390           clib_error_free (args->error);
391           break;
392         }
393     }
394
395   ad->dev_instance = ad - am->devices;
396   ad->per_interface_next_index = VNET_DEVICE_INPUT_NEXT_ETHERNET_INPUT;
397   ad->pool =
398     vlib_buffer_pool_get_default_for_numa (vm,
399                                            af_xdp_get_numa
400                                            (ad->linux_ifname));
401   if (!args->name)
402     ad->name =
403       (char *) format (0, "%s/%d", ad->linux_ifname, ad->dev_instance);
404   else
405     ad->name = (char *) format (0, "%s", args->name);
406
407   ethernet_mac_address_generate (ad->hwaddr);
408
409   /* create interface */
410   if (ethernet_register_interface (vnm, af_xdp_device_class.index,
411                                    ad->dev_instance, ad->hwaddr,
412                                    &ad->hw_if_index, af_xdp_flag_change))
413     {
414       args->rv = VNET_API_ERROR_INVALID_INTERFACE;
415       args->error =
416         clib_error_return (0, "ethernet_register_interface() failed");
417       goto err1;
418     }
419
420   sw = vnet_get_hw_sw_interface (vnm, ad->hw_if_index);
421   hw = vnet_get_hw_interface (vnm, ad->hw_if_index);
422   args->sw_if_index = ad->sw_if_index = sw->sw_if_index;
423   hw->caps |= VNET_HW_INTERFACE_CAP_SUPPORTS_INT_MODE;
424
425   vnet_hw_if_set_input_node (vnm, ad->hw_if_index, af_xdp_input_node.index);
426
427   for (i = 0; i < vec_len (ad->rxqs); i++)
428     {
429       af_xdp_rxq_t *rxq = vec_elt_at_index (ad->rxqs, i);
430       rxq->queue_index = vnet_hw_if_register_rx_queue (
431         vnm, ad->hw_if_index, i, VNET_HW_IF_RXQ_THREAD_ANY);
432       u8 *desc = format (0, "%U rxq %d", format_af_xdp_device_name,
433                          ad->dev_instance, i);
434       clib_file_t f = {
435         .file_descriptor = rxq->xsk_fd,
436         .flags = UNIX_FILE_EVENT_EDGE_TRIGGERED,
437         .private_data = rxq->queue_index,
438         .read_function = af_xdp_device_rxq_read_ready,
439         .description = desc,
440       };
441       rxq->file_index = clib_file_add (&file_main, &f);
442       vnet_hw_if_set_rx_queue_file_index (vnm, rxq->queue_index,
443                                           rxq->file_index);
444       af_xdp_device_set_rxq_mode (rxq, 1 /* polling */);
445     }
446
447   vnet_hw_if_update_runtime_data (vnm, ad->hw_if_index);
448
449   /* buffer template */
450   vec_validate_aligned (ad->buffer_template, 1, CLIB_CACHE_LINE_BYTES);
451   ad->buffer_template->flags = VLIB_BUFFER_TOTAL_LENGTH_VALID;
452   ad->buffer_template->ref_count = 1;
453   vnet_buffer (ad->buffer_template)->sw_if_index[VLIB_RX] = ad->sw_if_index;
454   vnet_buffer (ad->buffer_template)->sw_if_index[VLIB_TX] = (u32) ~ 0;
455   ad->buffer_template->buffer_pool_index = ad->pool;
456
457   return;
458
459 err1:
460   af_xdp_delete_if (vm, ad);
461 err0:
462   vlib_log_err (am->log_class, "%U", format_clib_error, args->error);
463 }
464
465 static clib_error_t *
466 af_xdp_interface_admin_up_down (vnet_main_t * vnm, u32 hw_if_index, u32 flags)
467 {
468   vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index);
469   af_xdp_main_t *am = &af_xdp_main;
470   af_xdp_device_t *ad = vec_elt_at_index (am->devices, hi->dev_instance);
471   uword is_up = (flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) != 0;
472
473   if (ad->flags & AF_XDP_DEVICE_F_ERROR)
474     return clib_error_return (0, "device is in error state");
475
476   if (is_up)
477     {
478       vnet_hw_interface_set_flags (vnm, ad->hw_if_index,
479                                    VNET_HW_INTERFACE_FLAG_LINK_UP);
480       ad->flags |= AF_XDP_DEVICE_F_ADMIN_UP;
481     }
482   else
483     {
484       vnet_hw_interface_set_flags (vnm, ad->hw_if_index, 0);
485       ad->flags &= ~AF_XDP_DEVICE_F_ADMIN_UP;
486     }
487   return 0;
488 }
489
490 static clib_error_t *
491 af_xdp_interface_rx_mode_change (vnet_main_t *vnm, u32 hw_if_index, u32 qid,
492                                  vnet_hw_if_rx_mode mode)
493 {
494   af_xdp_main_t *am = &af_xdp_main;
495   vnet_hw_interface_t *hw = vnet_get_hw_interface (vnm, hw_if_index);
496   af_xdp_device_t *ad = pool_elt_at_index (am->devices, hw->dev_instance);
497   af_xdp_rxq_t *rxq = vec_elt_at_index (ad->rxqs, qid);
498
499   switch (mode)
500     {
501     case VNET_HW_IF_RX_MODE_UNKNOWN:
502     case VNET_HW_IF_NUM_RX_MODES: /* fallthrough */
503       return clib_error_create ("uknown rx mode - doing nothing");
504     case VNET_HW_IF_RX_MODE_DEFAULT:
505     case VNET_HW_IF_RX_MODE_POLLING: /* fallthrough */
506       if (rxq->is_polling)
507         break;
508       af_xdp_device_set_rxq_mode (rxq, 1 /* polling */);
509       break;
510     case VNET_HW_IF_RX_MODE_INTERRUPT:
511     case VNET_HW_IF_RX_MODE_ADAPTIVE: /* fallthrough */
512       if (0 == rxq->is_polling)
513         break;
514       af_xdp_device_set_rxq_mode (rxq, 0 /* interrupt */);
515       break;
516     }
517
518   return 0;
519 }
520
521 static void
522 af_xdp_set_interface_next_node (vnet_main_t * vnm, u32 hw_if_index,
523                                 u32 node_index)
524 {
525   af_xdp_main_t *am = &af_xdp_main;
526   vnet_hw_interface_t *hw = vnet_get_hw_interface (vnm, hw_if_index);
527   af_xdp_device_t *ad = pool_elt_at_index (am->devices, hw->dev_instance);
528
529   /* Shut off redirection */
530   if (node_index == ~0)
531     {
532       ad->per_interface_next_index = node_index;
533       return;
534     }
535
536   ad->per_interface_next_index =
537     vlib_node_add_next (vlib_get_main (), af_xdp_input_node.index,
538                         node_index);
539 }
540
541 static char *af_xdp_tx_func_error_strings[] = {
542 #define _(n,s) s,
543   foreach_af_xdp_tx_func_error
544 #undef _
545 };
546
547 static void
548 af_xdp_clear (u32 dev_instance)
549 {
550   af_xdp_main_t *am = &af_xdp_main;
551   af_xdp_device_t *ad = pool_elt_at_index (am->devices, dev_instance);
552   clib_error_free (ad->error);
553 }
554
555 /* *INDENT-OFF* */
556 VNET_DEVICE_CLASS (af_xdp_device_class) = {
557   .name = "AF_XDP interface",
558   .format_device = format_af_xdp_device,
559   .format_device_name = format_af_xdp_device_name,
560   .admin_up_down_function = af_xdp_interface_admin_up_down,
561   .rx_mode_change_function = af_xdp_interface_rx_mode_change,
562   .rx_redirect_to_node = af_xdp_set_interface_next_node,
563   .tx_function_n_errors = AF_XDP_TX_N_ERROR,
564   .tx_function_error_strings = af_xdp_tx_func_error_strings,
565   .mac_addr_change_function = af_xdp_mac_change,
566   .clear_counters = af_xdp_clear,
567 };
568 /* *INDENT-ON* */
569
570 clib_error_t *
571 af_xdp_init (vlib_main_t * vm)
572 {
573   af_xdp_main_t *am = &af_xdp_main;
574
575   am->log_class = vlib_log_register_class ("af_xdp", 0);
576
577   return 0;
578 }
579
580 VLIB_INIT_FUNCTION (af_xdp_init);
581
582 /*
583  * fd.io coding-style-patch-verification: ON
584  *
585  * Local Variables:
586  * eval: (c-set-style "gnu")
587  * End:
588  */