dpdk:remove duplicate code
[vpp.git] / src / plugins / dpdk / device / init.c
1 /*
2  * Copyright (c) 2015 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 #include <vnet/vnet.h>
16 #include <vppinfra/vec.h>
17 #include <vppinfra/error.h>
18 #include <vppinfra/format.h>
19 #include <vppinfra/bitmap.h>
20 #include <vppinfra/linux/sysfs.h>
21 #include <vlib/unix/unix.h>
22
23 #include <vnet/ethernet/ethernet.h>
24 #include <dpdk/device/dpdk.h>
25 #include <vlib/pci/pci.h>
26
27 #include <rte_ring.h>
28
29 #include <stdio.h>
30 #include <stdlib.h>
31 #include <unistd.h>
32 #include <sys/stat.h>
33 #include <sys/mount.h>
34 #include <string.h>
35 #include <fcntl.h>
36
37 #include <dpdk/device/dpdk_priv.h>
38
39 dpdk_main_t dpdk_main;
40 dpdk_config_main_t dpdk_config_main;
41
42 #define LINK_STATE_ELOGS        0
43
44 /* Port configuration, mildly modified Intel app values */
45
46 static struct rte_eth_conf port_conf_template = {
47   .rxmode = {
48              .split_hdr_size = 0,
49              .header_split = 0,         /**< Header Split disabled */
50              .hw_ip_checksum = 0,       /**< IP checksum offload disabled */
51              .hw_vlan_filter = 0,       /**< VLAN filtering disabled */
52              .hw_strip_crc = 0,         /**< CRC stripped by hardware */
53              },
54   .txmode = {
55              .mq_mode = ETH_MQ_TX_NONE,
56              },
57 };
58
59 static dpdk_port_type_t
60 port_type_from_speed_capa (struct rte_eth_dev_info *dev_info)
61 {
62
63   if (dev_info->speed_capa & ETH_LINK_SPEED_100G)
64     return VNET_DPDK_PORT_TYPE_ETH_100G;
65   else if (dev_info->speed_capa & ETH_LINK_SPEED_50G)
66     return VNET_DPDK_PORT_TYPE_ETH_50G;
67   else if (dev_info->speed_capa & ETH_LINK_SPEED_40G)
68     return VNET_DPDK_PORT_TYPE_ETH_40G;
69   else if (dev_info->speed_capa & ETH_LINK_SPEED_25G)
70     return VNET_DPDK_PORT_TYPE_ETH_25G;
71   else if (dev_info->speed_capa & ETH_LINK_SPEED_10G)
72     return VNET_DPDK_PORT_TYPE_ETH_10G;
73   else if (dev_info->speed_capa & ETH_LINK_SPEED_1G)
74     return VNET_DPDK_PORT_TYPE_ETH_1G;
75
76   return VNET_DPDK_PORT_TYPE_UNKNOWN;
77 }
78
79
80 static u32
81 dpdk_flag_change (vnet_main_t * vnm, vnet_hw_interface_t * hi, u32 flags)
82 {
83   dpdk_main_t *dm = &dpdk_main;
84   dpdk_device_t *xd = vec_elt_at_index (dm->devices, hi->dev_instance);
85   u32 old = 0;
86
87   if (ETHERNET_INTERFACE_FLAG_CONFIG_PROMISC (flags))
88     {
89       old = (xd->flags & DPDK_DEVICE_FLAG_PROMISC) != 0;
90
91       if (flags & ETHERNET_INTERFACE_FLAG_ACCEPT_ALL)
92         xd->flags |= DPDK_DEVICE_FLAG_PROMISC;
93       else
94         xd->flags &= ~DPDK_DEVICE_FLAG_PROMISC;
95
96       if (xd->flags & DPDK_DEVICE_FLAG_ADMIN_UP)
97         {
98           if (xd->flags & DPDK_DEVICE_FLAG_PROMISC)
99             rte_eth_promiscuous_enable (xd->device_index);
100           else
101             rte_eth_promiscuous_disable (xd->device_index);
102         }
103     }
104   else if (ETHERNET_INTERFACE_FLAG_CONFIG_MTU (flags))
105     {
106       xd->port_conf.rxmode.max_rx_pkt_len = hi->max_packet_bytes;
107       dpdk_device_setup (xd);
108     }
109   return old;
110 }
111
112 static void
113 dpdk_device_lock_init (dpdk_device_t * xd)
114 {
115   int q;
116   vec_validate (xd->lockp, xd->tx_q_used - 1);
117   for (q = 0; q < xd->tx_q_used; q++)
118     {
119       xd->lockp[q] = clib_mem_alloc_aligned (CLIB_CACHE_LINE_BYTES,
120                                              CLIB_CACHE_LINE_BYTES);
121       memset ((void *) xd->lockp[q], 0, CLIB_CACHE_LINE_BYTES);
122     }
123 }
124
125 static struct rte_mempool_ops *
126 get_ops_by_name (i8 * ops_name)
127 {
128   u32 i;
129
130   for (i = 0; i < rte_mempool_ops_table.num_ops; i++)
131     {
132       if (!strcmp (ops_name, rte_mempool_ops_table.ops[i].name))
133         return &rte_mempool_ops_table.ops[i];
134     }
135
136   return 0;
137 }
138
139 static int
140 dpdk_ring_alloc (struct rte_mempool *mp)
141 {
142   u32 rg_flags = 0, count;
143   i32 ret;
144   i8 rg_name[RTE_RING_NAMESIZE];
145   struct rte_ring *r;
146
147   ret = snprintf (rg_name, sizeof (rg_name), RTE_MEMPOOL_MZ_FORMAT, mp->name);
148   if (ret < 0 || ret >= (i32) sizeof (rg_name))
149     return -ENAMETOOLONG;
150
151   /* ring flags */
152   if (mp->flags & MEMPOOL_F_SP_PUT)
153     rg_flags |= RING_F_SP_ENQ;
154   if (mp->flags & MEMPOOL_F_SC_GET)
155     rg_flags |= RING_F_SC_DEQ;
156
157   count = rte_align32pow2 (mp->size + 1);
158   /*
159    * Allocate the ring that will be used to store objects.
160    * Ring functions will return appropriate errors if we are
161    * running as a secondary process etc., so no checks made
162    * in this function for that condition.
163    */
164   /* XXX can we get memory from the right socket? */
165   r = clib_mem_alloc_aligned (rte_ring_get_memsize (count),
166                               CLIB_CACHE_LINE_BYTES);
167
168   /* XXX rte_ring_lookup will not work */
169
170   ret = rte_ring_init (r, rg_name, count, rg_flags);
171   if (ret)
172     return ret;
173
174   mp->pool_data = r;
175
176   return 0;
177 }
178
179 static clib_error_t *
180 dpdk_lib_init (dpdk_main_t * dm)
181 {
182   u32 nports;
183   u32 nb_desc = 0;
184   int i;
185   clib_error_t *error;
186   vlib_main_t *vm = vlib_get_main ();
187   vlib_thread_main_t *tm = vlib_get_thread_main ();
188   vnet_device_main_t *vdm = &vnet_device_main;
189   vnet_sw_interface_t *sw;
190   vnet_hw_interface_t *hi;
191   dpdk_device_t *xd;
192   vlib_pci_addr_t last_pci_addr;
193   u32 last_pci_addr_port = 0;
194   vlib_thread_registration_t *tr_hqos;
195   uword *p_hqos;
196
197   u32 next_hqos_cpu = 0;
198   u8 af_packet_port_id = 0;
199   u8 bond_ether_port_id = 0;
200   last_pci_addr.as_u32 = ~0;
201
202   dm->hqos_cpu_first_index = 0;
203   dm->hqos_cpu_count = 0;
204
205   /* find out which cpus will be used for I/O TX */
206   p_hqos = hash_get_mem (tm->thread_registrations_by_name, "hqos-threads");
207   tr_hqos = p_hqos ? (vlib_thread_registration_t *) p_hqos[0] : 0;
208
209   if (tr_hqos && tr_hqos->count > 0)
210     {
211       dm->hqos_cpu_first_index = tr_hqos->first_index;
212       dm->hqos_cpu_count = tr_hqos->count;
213     }
214
215   vec_validate_aligned (dm->devices_by_hqos_cpu, tm->n_vlib_mains - 1,
216                         CLIB_CACHE_LINE_BYTES);
217
218   nports = rte_eth_dev_count ();
219   if (nports < 1)
220     {
221       clib_warning ("DPDK drivers found no ports...");
222     }
223
224   if (CLIB_DEBUG > 0)
225     clib_warning ("DPDK drivers found %d ports...", nports);
226
227   /*
228    * All buffers are all allocated from the same rte_mempool.
229    * Thus they all have the same number of data bytes.
230    */
231   dm->vlib_buffer_free_list_index =
232     vlib_buffer_get_or_create_free_list (vm,
233                                          VLIB_BUFFER_DEFAULT_FREE_LIST_BYTES,
234                                          "dpdk rx");
235
236   if (dm->conf->enable_tcp_udp_checksum)
237     dm->buffer_flags_template &= ~(VNET_BUFFER_F_L4_CHECKSUM_CORRECT
238                                    | VNET_BUFFER_F_L4_CHECKSUM_COMPUTED);
239
240   /* vlib_buffer_t template */
241   vec_validate_aligned (dm->buffer_templates, tm->n_vlib_mains - 1,
242                         CLIB_CACHE_LINE_BYTES);
243   for (i = 0; i < tm->n_vlib_mains; i++)
244     {
245       vlib_buffer_free_list_t *fl;
246       vlib_buffer_t *bt = vec_elt_at_index (dm->buffer_templates, i);
247       fl = vlib_buffer_get_free_list (vm,
248                                       VLIB_BUFFER_DEFAULT_FREE_LIST_INDEX);
249       vlib_buffer_init_for_free_list (bt, fl);
250       bt->flags = dm->buffer_flags_template;
251       vnet_buffer (bt)->sw_if_index[VLIB_TX] = (u32) ~ 0;
252     }
253
254   for (i = 0; i < nports; i++)
255     {
256       u8 addr[6];
257       u8 vlan_strip = 0;
258       int j;
259       struct rte_eth_dev_info dev_info;
260       struct rte_eth_link l;
261       dpdk_device_config_t *devconf = 0;
262       vlib_pci_addr_t pci_addr;
263       uword *p = 0;
264
265       rte_eth_dev_info_get (i, &dev_info);
266       if (dev_info.pci_dev)     /* bonded interface has no pci info */
267         {
268           pci_addr.domain = dev_info.pci_dev->addr.domain;
269           pci_addr.bus = dev_info.pci_dev->addr.bus;
270           pci_addr.slot = dev_info.pci_dev->addr.devid;
271           pci_addr.function = dev_info.pci_dev->addr.function;
272           p =
273             hash_get (dm->conf->device_config_index_by_pci_addr,
274                       pci_addr.as_u32);
275         }
276
277       if (p)
278         devconf = pool_elt_at_index (dm->conf->dev_confs, p[0]);
279       else
280         devconf = &dm->conf->default_devconf;
281
282       /* Create vnet interface */
283       vec_add2_aligned (dm->devices, xd, 1, CLIB_CACHE_LINE_BYTES);
284       xd->nb_rx_desc = DPDK_NB_RX_DESC_DEFAULT;
285       xd->nb_tx_desc = DPDK_NB_TX_DESC_DEFAULT;
286       xd->cpu_socket = (i8) rte_eth_dev_socket_id (i);
287
288       /* Handle interface naming for devices with multiple ports sharing same PCI ID */
289       if (dev_info.pci_dev)
290         {
291           struct rte_eth_dev_info di = { 0 };
292           rte_eth_dev_info_get (i + 1, &di);
293           if (di.pci_dev && pci_addr.as_u32 != last_pci_addr.as_u32 &&
294               memcmp (&dev_info.pci_dev->addr, &di.pci_dev->addr,
295                       sizeof (struct rte_pci_addr)) == 0)
296             {
297               xd->interface_name_suffix = format (0, "0");
298               last_pci_addr.as_u32 = pci_addr.as_u32;
299               last_pci_addr_port = i;
300             }
301           else if (pci_addr.as_u32 == last_pci_addr.as_u32)
302             {
303               xd->interface_name_suffix =
304                 format (0, "%u", i - last_pci_addr_port);
305             }
306           else
307             {
308               last_pci_addr.as_u32 = ~0;
309             }
310         }
311       else
312         last_pci_addr.as_u32 = ~0;
313
314       clib_memcpy (&xd->tx_conf, &dev_info.default_txconf,
315                    sizeof (struct rte_eth_txconf));
316
317       if (dm->conf->no_tx_checksum_offload == 0)
318         xd->tx_conf.txq_flags &= ~ETH_TXQ_FLAGS_NOXSUMS;
319
320       if (dm->conf->no_multi_seg)
321         {
322           xd->tx_conf.txq_flags |= ETH_TXQ_FLAGS_NOMULTSEGS;
323           port_conf_template.rxmode.jumbo_frame = 0;
324           port_conf_template.rxmode.enable_scatter = 0;
325         }
326       else
327         {
328           xd->tx_conf.txq_flags &= ~ETH_TXQ_FLAGS_NOMULTSEGS;
329           port_conf_template.rxmode.jumbo_frame = 1;
330           port_conf_template.rxmode.enable_scatter = 1;
331           xd->flags |= DPDK_DEVICE_FLAG_MAYBE_MULTISEG;
332         }
333
334       clib_memcpy (&xd->port_conf, &port_conf_template,
335                    sizeof (struct rte_eth_conf));
336
337       xd->tx_q_used = clib_min (dev_info.max_tx_queues, tm->n_vlib_mains);
338
339       if (devconf->num_tx_queues > 0
340           && devconf->num_tx_queues < xd->tx_q_used)
341         xd->tx_q_used = clib_min (xd->tx_q_used, devconf->num_tx_queues);
342
343       if (devconf->num_rx_queues > 1
344           && dev_info.max_rx_queues >= devconf->num_rx_queues)
345         {
346           xd->rx_q_used = devconf->num_rx_queues;
347           xd->port_conf.rxmode.mq_mode = ETH_MQ_RX_RSS;
348           if (devconf->rss_fn == 0)
349             xd->port_conf.rx_adv_conf.rss_conf.rss_hf =
350               ETH_RSS_IP | ETH_RSS_UDP | ETH_RSS_TCP;
351           else
352             xd->port_conf.rx_adv_conf.rss_conf.rss_hf = devconf->rss_fn;
353         }
354       else
355         xd->rx_q_used = 1;
356
357       xd->flags |= DPDK_DEVICE_FLAG_PMD;
358
359       /* workaround for drivers not setting driver_name */
360       if ((!dev_info.driver_name) && (dev_info.pci_dev))
361         dev_info.driver_name = dev_info.pci_dev->driver->driver.name;
362
363       ASSERT (dev_info.driver_name);
364
365       if (!xd->pmd)
366         {
367
368
369 #define _(s,f) else if (dev_info.driver_name &&                 \
370                         !strcmp(dev_info.driver_name, s))       \
371                  xd->pmd = VNET_DPDK_PMD_##f;
372           if (0)
373             ;
374           foreach_dpdk_pmd
375 #undef _
376             else
377             xd->pmd = VNET_DPDK_PMD_UNKNOWN;
378
379           xd->port_type = VNET_DPDK_PORT_TYPE_UNKNOWN;
380           xd->nb_rx_desc = DPDK_NB_RX_DESC_DEFAULT;
381           xd->nb_tx_desc = DPDK_NB_TX_DESC_DEFAULT;
382
383           switch (xd->pmd)
384             {
385               /* Drivers with valid speed_capa set */
386             case VNET_DPDK_PMD_E1000EM:
387             case VNET_DPDK_PMD_IGB:
388             case VNET_DPDK_PMD_IXGBE:
389             case VNET_DPDK_PMD_I40E:
390               xd->port_type = port_type_from_speed_capa (&dev_info);
391               xd->flags |= DPDK_DEVICE_FLAG_TX_OFFLOAD |
392                 DPDK_DEVICE_FLAG_INTEL_PHDR_CKSUM;
393
394               break;
395             case VNET_DPDK_PMD_CXGBE:
396             case VNET_DPDK_PMD_MLX4:
397             case VNET_DPDK_PMD_MLX5:
398               xd->port_type = port_type_from_speed_capa (&dev_info);
399               break;
400
401               /* SR-IOV VFs */
402             case VNET_DPDK_PMD_IGBVF:
403             case VNET_DPDK_PMD_IXGBEVF:
404             case VNET_DPDK_PMD_I40EVF:
405               xd->port_type = VNET_DPDK_PORT_TYPE_ETH_VF;
406               xd->port_conf.rxmode.hw_strip_crc = 1;
407               break;
408
409             case VNET_DPDK_PMD_THUNDERX:
410               xd->port_type = VNET_DPDK_PORT_TYPE_ETH_VF;
411               xd->port_conf.rxmode.hw_strip_crc = 1;
412               break;
413
414             case VNET_DPDK_PMD_DPAA2:
415               xd->port_type = VNET_DPDK_PORT_TYPE_ETH_10G;
416               break;
417
418               /* Cisco VIC */
419             case VNET_DPDK_PMD_ENIC:
420               rte_eth_link_get_nowait (i, &l);
421               if (l.link_speed == 40000)
422                 xd->port_type = VNET_DPDK_PORT_TYPE_ETH_40G;
423               else
424                 xd->port_type = VNET_DPDK_PORT_TYPE_ETH_10G;
425               break;
426
427               /* Intel Red Rock Canyon */
428             case VNET_DPDK_PMD_FM10K:
429               xd->port_type = VNET_DPDK_PORT_TYPE_ETH_SWITCH;
430               xd->port_conf.rxmode.hw_strip_crc = 1;
431               break;
432
433               /* virtio */
434             case VNET_DPDK_PMD_VIRTIO:
435               xd->port_type = VNET_DPDK_PORT_TYPE_ETH_1G;
436               xd->nb_rx_desc = DPDK_NB_RX_DESC_VIRTIO;
437               xd->nb_tx_desc = DPDK_NB_TX_DESC_VIRTIO;
438               break;
439
440               /* vmxnet3 */
441             case VNET_DPDK_PMD_VMXNET3:
442               xd->port_type = VNET_DPDK_PORT_TYPE_ETH_1G;
443               xd->tx_conf.txq_flags |= ETH_TXQ_FLAGS_NOMULTSEGS;
444               break;
445
446             case VNET_DPDK_PMD_AF_PACKET:
447               xd->port_type = VNET_DPDK_PORT_TYPE_AF_PACKET;
448               xd->port_id = af_packet_port_id++;
449               break;
450
451             case VNET_DPDK_PMD_BOND:
452               xd->port_type = VNET_DPDK_PORT_TYPE_ETH_BOND;
453               xd->port_id = bond_ether_port_id++;
454               break;
455
456             case VNET_DPDK_PMD_VIRTIO_USER:
457               xd->port_type = VNET_DPDK_PORT_TYPE_VIRTIO_USER;
458               break;
459
460             default:
461               xd->port_type = VNET_DPDK_PORT_TYPE_UNKNOWN;
462             }
463
464           if (devconf->num_rx_desc)
465             xd->nb_rx_desc = devconf->num_rx_desc;
466
467           if (devconf->num_tx_desc)
468             xd->nb_tx_desc = devconf->num_tx_desc;
469         }
470
471       /*
472        * Ensure default mtu is not > the mtu read from the hardware.
473        * Otherwise rte_eth_dev_configure() will fail and the port will
474        * not be available.
475        */
476       if (ETHERNET_MAX_PACKET_BYTES > dev_info.max_rx_pktlen)
477         {
478           /*
479            * This device does not support the platforms's max frame
480            * size. Use it's advertised mru instead.
481            */
482           xd->port_conf.rxmode.max_rx_pkt_len = dev_info.max_rx_pktlen;
483         }
484       else
485         {
486           xd->port_conf.rxmode.max_rx_pkt_len = ETHERNET_MAX_PACKET_BYTES;
487
488           /*
489            * Some platforms do not account for Ethernet FCS (4 bytes) in
490            * MTU calculations. To interop with them increase mru but only
491            * if the device's settings can support it.
492            */
493           if ((dev_info.max_rx_pktlen >= (ETHERNET_MAX_PACKET_BYTES + 4)) &&
494               xd->port_conf.rxmode.hw_strip_crc)
495             {
496               /*
497                * Allow additional 4 bytes (for Ethernet FCS). These bytes are
498                * stripped by h/w and so will not consume any buffer memory.
499                */
500               xd->port_conf.rxmode.max_rx_pkt_len += 4;
501             }
502         }
503
504       if (xd->pmd == VNET_DPDK_PMD_AF_PACKET)
505         {
506           f64 now = vlib_time_now (vm);
507           u32 rnd;
508           rnd = (u32) (now * 1e6);
509           rnd = random_u32 (&rnd);
510           clib_memcpy (addr + 2, &rnd, sizeof (rnd));
511           addr[0] = 2;
512           addr[1] = 0xfe;
513         }
514       else
515         rte_eth_macaddr_get (i, (struct ether_addr *) addr);
516
517       if (xd->tx_q_used < tm->n_vlib_mains)
518         dpdk_device_lock_init (xd);
519
520       xd->device_index = xd - dm->devices;
521       ASSERT (i == xd->device_index);
522       xd->per_interface_next_index = ~0;
523
524       /* assign interface to input thread */
525       int q;
526
527       if (devconf->hqos_enabled)
528         {
529           xd->flags |= DPDK_DEVICE_FLAG_HQOS;
530
531           int cpu;
532           if (devconf->hqos.hqos_thread_valid)
533             {
534               if (devconf->hqos.hqos_thread >= dm->hqos_cpu_count)
535                 return clib_error_return (0, "invalid HQoS thread index");
536
537               cpu = dm->hqos_cpu_first_index + devconf->hqos.hqos_thread;
538             }
539           else
540             {
541               if (dm->hqos_cpu_count == 0)
542                 return clib_error_return (0, "no HQoS threads available");
543
544               cpu = dm->hqos_cpu_first_index + next_hqos_cpu;
545
546               next_hqos_cpu++;
547               if (next_hqos_cpu == dm->hqos_cpu_count)
548                 next_hqos_cpu = 0;
549
550               devconf->hqos.hqos_thread_valid = 1;
551               devconf->hqos.hqos_thread = cpu;
552             }
553
554           dpdk_device_and_queue_t *dq;
555           vec_add2 (dm->devices_by_hqos_cpu[cpu], dq, 1);
556           dq->device = xd->device_index;
557           dq->queue_id = 0;
558         }
559
560       vec_validate_aligned (xd->tx_vectors, tm->n_vlib_mains,
561                             CLIB_CACHE_LINE_BYTES);
562       for (j = 0; j < tm->n_vlib_mains; j++)
563         {
564           vec_validate_ha (xd->tx_vectors[j], xd->nb_tx_desc,
565                            sizeof (tx_ring_hdr_t), CLIB_CACHE_LINE_BYTES);
566           vec_reset_length (xd->tx_vectors[j]);
567         }
568
569       vec_validate_aligned (xd->rx_vectors, xd->rx_q_used,
570                             CLIB_CACHE_LINE_BYTES);
571       for (j = 0; j < xd->rx_q_used; j++)
572         {
573           vec_validate_aligned (xd->rx_vectors[j], VLIB_FRAME_SIZE - 1,
574                                 CLIB_CACHE_LINE_BYTES);
575           vec_reset_length (xd->rx_vectors[j]);
576         }
577
578       vec_validate_aligned (xd->d_trace_buffers, tm->n_vlib_mains,
579                             CLIB_CACHE_LINE_BYTES);
580
581
582       /* count the number of descriptors used for this device */
583       nb_desc += xd->nb_rx_desc + xd->nb_tx_desc * xd->tx_q_used;
584
585       error = ethernet_register_interface
586         (dm->vnet_main, dpdk_device_class.index, xd->device_index,
587          /* ethernet address */ addr,
588          &xd->hw_if_index, dpdk_flag_change);
589       if (error)
590         return error;
591
592       sw = vnet_get_hw_sw_interface (dm->vnet_main, xd->hw_if_index);
593       xd->vlib_sw_if_index = sw->sw_if_index;
594       vnet_hw_interface_set_input_node (dm->vnet_main, xd->hw_if_index,
595                                         dpdk_input_node.index);
596
597       if (devconf->workers)
598         {
599           int i;
600           q = 0;
601           /* *INDENT-OFF* */
602           clib_bitmap_foreach (i, devconf->workers, ({
603             vnet_hw_interface_assign_rx_thread (dm->vnet_main, xd->hw_if_index, q++,
604                                              vdm->first_worker_thread_index + i);
605           }));
606           /* *INDENT-ON* */
607         }
608       else
609         for (q = 0; q < xd->rx_q_used; q++)
610           {
611             vnet_hw_interface_assign_rx_thread (dm->vnet_main, xd->hw_if_index, q,      /* any */
612                                                 ~1);
613           }
614
615       hi = vnet_get_hw_interface (dm->vnet_main, xd->hw_if_index);
616
617       if (dm->conf->no_tx_checksum_offload == 0)
618         if (xd->flags & DPDK_DEVICE_FLAG_TX_OFFLOAD)
619           hi->flags |= VNET_HW_INTERFACE_FLAG_SUPPORTS_TX_L4_CKSUM_OFFLOAD;
620
621       dpdk_device_setup (xd);
622
623       if (vec_len (xd->errors))
624         clib_warning ("setup failed for device %U. Errors:\n  %U",
625                       format_dpdk_device_name, i,
626                       format_dpdk_device_errors, xd);
627
628       if (devconf->hqos_enabled)
629         {
630           clib_error_t *rv;
631           rv = dpdk_port_setup_hqos (xd, &devconf->hqos);
632           if (rv)
633             return rv;
634         }
635
636       /*
637        * For cisco VIC vNIC, set default to VLAN strip enabled, unless
638        * specified otherwise in the startup config.
639        * For other NICs default to VLAN strip disabled, unless specified
640        * otherwis in the startup config.
641        */
642       if (xd->pmd == VNET_DPDK_PMD_ENIC)
643         {
644           if (devconf->vlan_strip_offload != DPDK_DEVICE_VLAN_STRIP_OFF)
645             vlan_strip = 1;     /* remove vlan tag from VIC port by default */
646           else
647             clib_warning ("VLAN strip disabled for interface\n");
648         }
649       else if (devconf->vlan_strip_offload == DPDK_DEVICE_VLAN_STRIP_ON)
650         vlan_strip = 1;
651
652       if (vlan_strip)
653         {
654           int vlan_off;
655           vlan_off = rte_eth_dev_get_vlan_offload (xd->device_index);
656           vlan_off |= ETH_VLAN_STRIP_OFFLOAD;
657           xd->port_conf.rxmode.hw_vlan_strip = vlan_off;
658           if (rte_eth_dev_set_vlan_offload (xd->device_index, vlan_off) == 0)
659             clib_warning ("VLAN strip enabled for interface\n");
660           else
661             clib_warning ("VLAN strip cannot be supported by interface\n");
662         }
663
664       hi->max_l3_packet_bytes[VLIB_RX] = hi->max_l3_packet_bytes[VLIB_TX] =
665         xd->port_conf.rxmode.max_rx_pkt_len - sizeof (ethernet_header_t);
666
667       rte_eth_dev_set_mtu (xd->device_index, hi->max_packet_bytes);
668     }
669
670   if (nb_desc > dm->conf->num_mbufs)
671     clib_warning ("%d mbufs allocated but total rx/tx ring size is %d\n",
672                   dm->conf->num_mbufs, nb_desc);
673
674   return 0;
675 }
676
677 static void
678 dpdk_bind_devices_to_uio (dpdk_config_main_t * conf)
679 {
680   vlib_pci_main_t *pm = &pci_main;
681   clib_error_t *error;
682   vlib_pci_device_t *d;
683   u8 *pci_addr = 0;
684   int num_whitelisted = vec_len (conf->dev_confs);
685
686   /* *INDENT-OFF* */
687   pool_foreach (d, pm->pci_devs, ({
688     dpdk_device_config_t * devconf = 0;
689     vec_reset_length (pci_addr);
690     pci_addr = format (pci_addr, "%U%c", format_vlib_pci_addr, &d->bus_address, 0);
691
692     if (d->device_class != PCI_CLASS_NETWORK_ETHERNET && d->device_class != PCI_CLASS_PROCESSOR_CO)
693       continue;
694
695     if (num_whitelisted)
696       {
697         uword * p = hash_get (conf->device_config_index_by_pci_addr, d->bus_address.as_u32);
698
699         if (!p)
700           continue;
701
702         devconf = pool_elt_at_index (conf->dev_confs, p[0]);
703       }
704
705     /* virtio */
706     if (d->vendor_id == 0x1af4 &&
707             (d->device_id == VIRTIO_PCI_LEGACY_DEVICEID_NET ||
708              d->device_id == VIRTIO_PCI_MODERN_DEVICEID_NET))
709       ;
710     /* vmxnet3 */
711     else if (d->vendor_id == 0x15ad && d->device_id == 0x07b0)
712       ;
713     /* all Intel network devices */
714     else if (d->vendor_id == 0x8086 && d->device_class == PCI_CLASS_NETWORK_ETHERNET)
715       ;
716     /* all Intel QAT devices VFs */
717     else if (d->vendor_id == 0x8086 && d->device_class == PCI_CLASS_PROCESSOR_CO &&
718         (d->device_id == 0x0443 || d->device_id == 0x37c9 || d->device_id == 0x19e3))
719       ;
720     /* Cisco VIC */
721     else if (d->vendor_id == 0x1137 && d->device_id == 0x0043)
722       ;
723     /* Chelsio T4/T5 */
724     else if (d->vendor_id == 0x1425 && (d->device_id & 0xe000) == 0x4000)
725       ;
726     /* Mellanox  */
727     else if (d->vendor_id == 0x15b3 && d->device_id >= 0x1013 && d->device_id <= 0x101a)
728       {
729         continue;
730       }
731     else
732       {
733         clib_warning ("Unsupported PCI device 0x%04x:0x%04x found "
734                       "at PCI address %s\n", (u16) d->vendor_id, (u16) d->device_id,
735                       pci_addr);
736         continue;
737       }
738
739     error = vlib_pci_bind_to_uio (d, (char *) conf->uio_driver_name);
740
741     if (error)
742       {
743         if (devconf == 0)
744           {
745             pool_get (conf->dev_confs, devconf);
746             hash_set (conf->device_config_index_by_pci_addr, d->bus_address.as_u32,
747                       devconf - conf->dev_confs);
748             devconf->pci_addr.as_u32 = d->bus_address.as_u32;
749           }
750         devconf->is_blacklisted = 1;
751         clib_error_report (error);
752       }
753   }));
754   /* *INDENT-ON* */
755   vec_free (pci_addr);
756 }
757
758 static clib_error_t *
759 dpdk_device_config (dpdk_config_main_t * conf, vlib_pci_addr_t pci_addr,
760                     unformat_input_t * input, u8 is_default)
761 {
762   clib_error_t *error = 0;
763   uword *p;
764   dpdk_device_config_t *devconf;
765   unformat_input_t sub_input;
766
767   if (is_default)
768     {
769       devconf = &conf->default_devconf;
770     }
771   else
772     {
773       p = hash_get (conf->device_config_index_by_pci_addr, pci_addr.as_u32);
774
775       if (!p)
776         {
777           pool_get (conf->dev_confs, devconf);
778           hash_set (conf->device_config_index_by_pci_addr, pci_addr.as_u32,
779                     devconf - conf->dev_confs);
780         }
781       else
782         return clib_error_return (0,
783                                   "duplicate configuration for PCI address %U",
784                                   format_vlib_pci_addr, &pci_addr);
785     }
786
787   devconf->pci_addr.as_u32 = pci_addr.as_u32;
788   devconf->hqos_enabled = 0;
789   dpdk_device_config_hqos_default (&devconf->hqos);
790
791   if (!input)
792     return 0;
793
794   unformat_skip_white_space (input);
795   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
796     {
797       if (unformat (input, "num-rx-queues %u", &devconf->num_rx_queues))
798         ;
799       else if (unformat (input, "num-tx-queues %u", &devconf->num_tx_queues))
800         ;
801       else if (unformat (input, "num-rx-desc %u", &devconf->num_rx_desc))
802         ;
803       else if (unformat (input, "num-tx-desc %u", &devconf->num_tx_desc))
804         ;
805       else if (unformat (input, "workers %U", unformat_bitmap_list,
806                          &devconf->workers))
807         ;
808       else
809         if (unformat
810             (input, "rss %U", unformat_vlib_cli_sub_input, &sub_input))
811         {
812           error = unformat_rss_fn (&sub_input, &devconf->rss_fn);
813           if (error)
814             break;
815         }
816       else if (unformat (input, "vlan-strip-offload off"))
817         devconf->vlan_strip_offload = DPDK_DEVICE_VLAN_STRIP_OFF;
818       else if (unformat (input, "vlan-strip-offload on"))
819         devconf->vlan_strip_offload = DPDK_DEVICE_VLAN_STRIP_ON;
820       else
821         if (unformat
822             (input, "hqos %U", unformat_vlib_cli_sub_input, &sub_input))
823         {
824           devconf->hqos_enabled = 1;
825           error = unformat_hqos (&sub_input, &devconf->hqos);
826           if (error)
827             break;
828         }
829       else if (unformat (input, "hqos"))
830         {
831           devconf->hqos_enabled = 1;
832         }
833       else
834         {
835           error = clib_error_return (0, "unknown input `%U'",
836                                      format_unformat_error, input);
837           break;
838         }
839     }
840
841   if (error)
842     return error;
843
844   if (devconf->workers && devconf->num_rx_queues == 0)
845     devconf->num_rx_queues = clib_bitmap_count_set_bits (devconf->workers);
846   else if (devconf->workers &&
847            clib_bitmap_count_set_bits (devconf->workers) !=
848            devconf->num_rx_queues)
849     error =
850       clib_error_return (0,
851                          "%U: number of worker threadds must be "
852                          "equal to number of rx queues", format_vlib_pci_addr,
853                          &pci_addr);
854
855   return error;
856 }
857
858 static clib_error_t *
859 dpdk_config (vlib_main_t * vm, unformat_input_t * input)
860 {
861   clib_error_t *error = 0;
862   dpdk_main_t *dm = &dpdk_main;
863   dpdk_config_main_t *conf = &dpdk_config_main;
864   vlib_thread_main_t *tm = vlib_get_thread_main ();
865   dpdk_device_config_t *devconf;
866   vlib_pci_addr_t pci_addr;
867   unformat_input_t sub_input;
868   uword x;
869   u8 *s, *tmp = 0;
870   u8 *rte_cmd = 0, *ethname = 0;
871   u32 log_level;
872   int ret, i;
873   int num_whitelisted = 0;
874   u8 no_pci = 0;
875   u8 no_huge = 0;
876   u8 huge_dir = 0;
877   u8 file_prefix = 0;
878   u8 *socket_mem = 0;
879   u8 *huge_dir_path = 0;
880
881   huge_dir_path =
882     format (0, "%s/hugepages%c", vlib_unix_get_runtime_dir (), 0);
883
884   conf->device_config_index_by_pci_addr = hash_create (0, sizeof (uword));
885   log_level = RTE_LOG_NOTICE;
886
887   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
888     {
889       /* Prime the pump */
890       if (unformat (input, "no-hugetlb"))
891         {
892           vec_add1 (conf->eal_init_args, (u8 *) "no-huge");
893           no_huge = 1;
894         }
895
896       else if (unformat (input, "enable-tcp-udp-checksum"))
897         conf->enable_tcp_udp_checksum = 1;
898
899       else if (unformat (input, "no-tx-checksum-offload"))
900         conf->no_tx_checksum_offload = 1;
901
902       else if (unformat (input, "decimal-interface-names"))
903         conf->interface_name_format_decimal = 1;
904
905       else if (unformat (input, "log-level %U", unformat_dpdk_log_level, &x))
906         log_level = x;
907
908       else if (unformat (input, "no-multi-seg"))
909         conf->no_multi_seg = 1;
910
911       else if (unformat (input, "dev default %U", unformat_vlib_cli_sub_input,
912                          &sub_input))
913         {
914           error =
915             dpdk_device_config (conf, (vlib_pci_addr_t) (u32) ~ 1, &sub_input,
916                                 1);
917
918           if (error)
919             return error;
920         }
921       else
922         if (unformat
923             (input, "dev %U %U", unformat_vlib_pci_addr, &pci_addr,
924              unformat_vlib_cli_sub_input, &sub_input))
925         {
926           error = dpdk_device_config (conf, pci_addr, &sub_input, 0);
927
928           if (error)
929             return error;
930
931           num_whitelisted++;
932         }
933       else if (unformat (input, "dev %U", unformat_vlib_pci_addr, &pci_addr))
934         {
935           error = dpdk_device_config (conf, pci_addr, 0, 0);
936
937           if (error)
938             return error;
939
940           num_whitelisted++;
941         }
942       else if (unformat (input, "num-mbufs %d", &conf->num_mbufs))
943         ;
944       else if (unformat (input, "uio-driver %s", &conf->uio_driver_name))
945         ;
946       else if (unformat (input, "socket-mem %s", &socket_mem))
947         ;
948       else if (unformat (input, "no-pci"))
949         {
950           no_pci = 1;
951           tmp = format (0, "--no-pci%c", 0);
952           vec_add1 (conf->eal_init_args, tmp);
953         }
954       else if (unformat (input, "poll-sleep %d", &dm->poll_sleep_usec))
955         ;
956
957 #define _(a)                                    \
958       else if (unformat(input, #a))             \
959         {                                       \
960           tmp = format (0, "--%s%c", #a, 0);    \
961           vec_add1 (conf->eal_init_args, tmp);    \
962         }
963       foreach_eal_double_hyphen_predicate_arg
964 #undef _
965 #define _(a)                                          \
966         else if (unformat(input, #a " %s", &s))       \
967           {                                           \
968             if (!strncmp(#a, "huge-dir", 8))          \
969               huge_dir = 1;                           \
970             else if (!strncmp(#a, "file-prefix", 11)) \
971               file_prefix = 1;                        \
972             tmp = format (0, "--%s%c", #a, 0);        \
973             vec_add1 (conf->eal_init_args, tmp);      \
974             vec_add1 (s, 0);                          \
975             if (!strncmp(#a, "vdev", 4))              \
976               if (strstr((char*)s, "af_packet"))      \
977                 clib_warning ("af_packet obsoleted. Use CLI 'create host-interface'."); \
978             vec_add1 (conf->eal_init_args, s);        \
979           }
980         foreach_eal_double_hyphen_arg
981 #undef _
982 #define _(a,b)                                          \
983           else if (unformat(input, #a " %s", &s))       \
984             {                                           \
985               tmp = format (0, "-%s%c", #b, 0);         \
986               vec_add1 (conf->eal_init_args, tmp);      \
987               vec_add1 (s, 0);                          \
988               vec_add1 (conf->eal_init_args, s);        \
989             }
990         foreach_eal_single_hyphen_arg
991 #undef _
992 #define _(a,b)                                          \
993             else if (unformat(input, #a " %s", &s))     \
994               {                                         \
995                 tmp = format (0, "-%s%c", #b, 0);       \
996                 vec_add1 (conf->eal_init_args, tmp);    \
997                 vec_add1 (s, 0);                        \
998                 vec_add1 (conf->eal_init_args, s);      \
999                 conf->a##_set_manually = 1;             \
1000               }
1001         foreach_eal_single_hyphen_mandatory_arg
1002 #undef _
1003         else if (unformat (input, "default"))
1004         ;
1005
1006       else if (unformat_skip_white_space (input))
1007         ;
1008       else
1009         {
1010           error = clib_error_return (0, "unknown input `%U'",
1011                                      format_unformat_error, input);
1012           goto done;
1013         }
1014     }
1015
1016   if (!conf->uio_driver_name)
1017     conf->uio_driver_name = format (0, "uio_pci_generic%c", 0);
1018
1019   /*
1020    * Use 1G huge pages if available.
1021    */
1022   if (!no_huge && !huge_dir)
1023     {
1024       u32 x, *mem_by_socket = 0;
1025       uword c = 0;
1026       int rv;
1027
1028       umount ((char *) huge_dir_path);
1029
1030       /* Process "socket-mem" parameter value */
1031       if (vec_len (socket_mem))
1032         {
1033           unformat_input_t in;
1034           unformat_init_vector (&in, socket_mem);
1035           while (unformat_check_input (&in) != UNFORMAT_END_OF_INPUT)
1036             {
1037               if (unformat (&in, "%u,", &x))
1038                 ;
1039               else if (unformat (&in, "%u", &x))
1040                 ;
1041               else if (unformat (&in, ","))
1042                 x = 0;
1043               else
1044                 break;
1045
1046               vec_add1 (mem_by_socket, x);
1047             }
1048           /* Note: unformat_free vec_frees(in.buffer), aka socket_mem... */
1049           unformat_free (&in);
1050           socket_mem = 0;
1051         }
1052       else
1053         {
1054           /* *INDENT-OFF* */
1055           clib_bitmap_foreach (c, tm->cpu_socket_bitmap, (
1056             {
1057               vec_validate(mem_by_socket, c);
1058               mem_by_socket[c] = 64; /* default per-socket mem */
1059             }
1060           ));
1061           /* *INDENT-ON* */
1062         }
1063
1064       /* *INDENT-OFF* */
1065       clib_bitmap_foreach (c, tm->cpu_socket_bitmap, (
1066         {
1067           clib_error_t *e;
1068
1069           vec_validate(mem_by_socket, c);
1070
1071           e = clib_sysfs_prealloc_hugepages(c, 2 << 10, mem_by_socket[c] / 2);
1072           if (e)
1073             clib_error_report (e);
1074       }));
1075       /* *INDENT-ON* */
1076
1077       if (mem_by_socket == 0)
1078         {
1079           error = clib_error_return (0, "mem_by_socket NULL");
1080           goto done;
1081         }
1082       _vec_len (mem_by_socket) = c + 1;
1083
1084       /* regenerate socket_mem string */
1085       vec_foreach_index (x, mem_by_socket)
1086         socket_mem = format (socket_mem, "%s%u",
1087                              socket_mem ? "," : "", mem_by_socket[x]);
1088       socket_mem = format (socket_mem, "%c", 0);
1089
1090       vec_free (mem_by_socket);
1091
1092       error = vlib_unix_recursive_mkdir ((char *) huge_dir_path);
1093       if (error)
1094         {
1095           goto done;
1096         }
1097
1098       rv = mount ("none", (char *) huge_dir_path, "hugetlbfs", 0, NULL);
1099
1100       if (rv)
1101         {
1102           error = clib_error_return (0, "mount failed %d", errno);
1103           goto done;
1104         }
1105
1106       tmp = format (0, "--huge-dir%c", 0);
1107       vec_add1 (conf->eal_init_args, tmp);
1108       tmp = format (0, "%s%c", huge_dir_path, 0);
1109       vec_add1 (conf->eal_init_args, tmp);
1110       if (!file_prefix)
1111         {
1112           tmp = format (0, "--file-prefix%c", 0);
1113           vec_add1 (conf->eal_init_args, tmp);
1114           tmp = format (0, "vpp%c", 0);
1115           vec_add1 (conf->eal_init_args, tmp);
1116         }
1117     }
1118
1119   vec_free (rte_cmd);
1120   vec_free (ethname);
1121
1122   if (error)
1123     return error;
1124
1125   /* I'll bet that -c and -n must be the first and second args... */
1126   if (!conf->coremask_set_manually)
1127     {
1128       vlib_thread_registration_t *tr;
1129       uword *coremask = 0;
1130       int i;
1131
1132       /* main thread core */
1133       coremask = clib_bitmap_set (coremask, tm->main_lcore, 1);
1134
1135       for (i = 0; i < vec_len (tm->registrations); i++)
1136         {
1137           tr = tm->registrations[i];
1138           coremask = clib_bitmap_or (coremask, tr->coremask);
1139         }
1140
1141       vec_insert (conf->eal_init_args, 2, 1);
1142       conf->eal_init_args[1] = (u8 *) "-c";
1143       tmp = format (0, "%U%c", format_bitmap_hex, coremask, 0);
1144       conf->eal_init_args[2] = tmp;
1145       clib_bitmap_free (coremask);
1146     }
1147
1148   if (!conf->nchannels_set_manually)
1149     {
1150       vec_insert (conf->eal_init_args, 2, 3);
1151       conf->eal_init_args[3] = (u8 *) "-n";
1152       tmp = format (0, "%d", conf->nchannels);
1153       conf->eal_init_args[4] = tmp;
1154     }
1155
1156   if (no_pci == 0 && geteuid () == 0)
1157     dpdk_bind_devices_to_uio (conf);
1158
1159 #define _(x) \
1160     if (devconf->x == 0 && conf->default_devconf.x > 0) \
1161       devconf->x = conf->default_devconf.x ;
1162
1163   /* *INDENT-OFF* */
1164   pool_foreach (devconf, conf->dev_confs, ({
1165
1166     /* default per-device config items */
1167     foreach_dpdk_device_config_item
1168
1169     /* add DPDK EAL whitelist/blacklist entry */
1170     if (num_whitelisted > 0 && devconf->is_blacklisted == 0)
1171       {
1172         tmp = format (0, "-w%c", 0);
1173         vec_add1 (conf->eal_init_args, tmp);
1174         tmp = format (0, "%U%c", format_vlib_pci_addr, &devconf->pci_addr, 0);
1175         vec_add1 (conf->eal_init_args, tmp);
1176       }
1177     else if (num_whitelisted == 0 && devconf->is_blacklisted != 0)
1178       {
1179         tmp = format (0, "-b%c", 0);
1180         vec_add1 (conf->eal_init_args, tmp);
1181         tmp = format (0, "%U%c", format_vlib_pci_addr, &devconf->pci_addr, 0);
1182         vec_add1 (conf->eal_init_args, tmp);
1183       }
1184   }));
1185   /* *INDENT-ON* */
1186
1187 #undef _
1188
1189   /* set master-lcore */
1190   tmp = format (0, "--master-lcore%c", 0);
1191   vec_add1 (conf->eal_init_args, tmp);
1192   tmp = format (0, "%u%c", tm->main_lcore, 0);
1193   vec_add1 (conf->eal_init_args, tmp);
1194
1195   /* set socket-mem */
1196   tmp = format (0, "--socket-mem%c", 0);
1197   vec_add1 (conf->eal_init_args, tmp);
1198   tmp = format (0, "%s%c", socket_mem, 0);
1199   vec_add1 (conf->eal_init_args, tmp);
1200
1201   /* NULL terminate the "argv" vector, in case of stupidity */
1202   vec_add1 (conf->eal_init_args, 0);
1203   _vec_len (conf->eal_init_args) -= 1;
1204
1205   /* Set up DPDK eal and packet mbuf pool early. */
1206
1207   rte_log_set_global_level (log_level);
1208
1209   vm = vlib_get_main ();
1210
1211   /* make copy of args as rte_eal_init tends to mess up with arg array */
1212   for (i = 1; i < vec_len (conf->eal_init_args); i++)
1213     conf->eal_init_args_str = format (conf->eal_init_args_str, "%s ",
1214                                       conf->eal_init_args[i]);
1215
1216   clib_warning ("EAL init args: %s", conf->eal_init_args_str);
1217   ret =
1218     rte_eal_init (vec_len (conf->eal_init_args),
1219                   (char **) conf->eal_init_args);
1220
1221   /* lazy umount hugepages */
1222   umount2 ((char *) huge_dir_path, MNT_DETACH);
1223   rmdir ((char *) huge_dir_path);
1224   vec_free (huge_dir_path);
1225
1226   if (ret < 0)
1227     return clib_error_return (0, "rte_eal_init returned %d", ret);
1228
1229   /* Dump the physical memory layout prior to creating the mbuf_pool */
1230   fprintf (stdout, "DPDK physical memory layout:\n");
1231   rte_dump_physmem_layout (stdout);
1232
1233   /* set custom ring memory allocator */
1234   {
1235     struct rte_mempool_ops *ops = NULL;
1236
1237     ops = get_ops_by_name ("ring_sp_sc");
1238     ops->alloc = dpdk_ring_alloc;
1239
1240     ops = get_ops_by_name ("ring_mp_sc");
1241     ops->alloc = dpdk_ring_alloc;
1242
1243     ops = get_ops_by_name ("ring_sp_mc");
1244     ops->alloc = dpdk_ring_alloc;
1245
1246     ops = get_ops_by_name ("ring_mp_mc");
1247     ops->alloc = dpdk_ring_alloc;
1248   }
1249
1250   /* main thread 1st */
1251   error = dpdk_buffer_pool_create (vm, conf->num_mbufs, rte_socket_id ());
1252   if (error)
1253     return error;
1254
1255   for (i = 0; i < RTE_MAX_LCORE; i++)
1256     {
1257       error = dpdk_buffer_pool_create (vm, conf->num_mbufs,
1258                                        rte_lcore_to_socket_id (i));
1259       if (error)
1260         return error;
1261     }
1262
1263 done:
1264   return error;
1265 }
1266
1267 VLIB_CONFIG_FUNCTION (dpdk_config, "dpdk");
1268
1269 void
1270 dpdk_update_link_state (dpdk_device_t * xd, f64 now)
1271 {
1272   vnet_main_t *vnm = vnet_get_main ();
1273   struct rte_eth_link prev_link = xd->link;
1274   u32 hw_flags = 0;
1275   u8 hw_flags_chg = 0;
1276
1277   /* only update link state for PMD interfaces */
1278   if ((xd->flags & DPDK_DEVICE_FLAG_PMD) == 0)
1279     return;
1280
1281   xd->time_last_link_update = now ? now : xd->time_last_link_update;
1282   memset (&xd->link, 0, sizeof (xd->link));
1283   rte_eth_link_get_nowait (xd->device_index, &xd->link);
1284
1285   if (LINK_STATE_ELOGS)
1286     {
1287       vlib_main_t *vm = vlib_get_main ();
1288       ELOG_TYPE_DECLARE (e) =
1289       {
1290       .format =
1291           "update-link-state: sw_if_index %d, admin_up %d,"
1292           "old link_state %d new link_state %d",.format_args = "i4i1i1i1",};
1293
1294       struct
1295       {
1296         u32 sw_if_index;
1297         u8 admin_up;
1298         u8 old_link_state;
1299         u8 new_link_state;
1300       } *ed;
1301       ed = ELOG_DATA (&vm->elog_main, e);
1302       ed->sw_if_index = xd->vlib_sw_if_index;
1303       ed->admin_up = (xd->flags & DPDK_DEVICE_FLAG_ADMIN_UP) != 0;
1304       ed->old_link_state = (u8)
1305         vnet_hw_interface_is_link_up (vnm, xd->hw_if_index);
1306       ed->new_link_state = (u8) xd->link.link_status;
1307     }
1308
1309   if ((xd->flags & (DPDK_DEVICE_FLAG_ADMIN_UP | DPDK_DEVICE_FLAG_BOND_SLAVE))
1310       && ((xd->link.link_status != 0) ^
1311           vnet_hw_interface_is_link_up (vnm, xd->hw_if_index)))
1312     {
1313       hw_flags_chg = 1;
1314       hw_flags |= (xd->link.link_status ? VNET_HW_INTERFACE_FLAG_LINK_UP : 0);
1315     }
1316
1317   if (hw_flags_chg || (xd->link.link_duplex != prev_link.link_duplex))
1318     {
1319       hw_flags_chg = 1;
1320       switch (xd->link.link_duplex)
1321         {
1322         case ETH_LINK_HALF_DUPLEX:
1323           hw_flags |= VNET_HW_INTERFACE_FLAG_HALF_DUPLEX;
1324           break;
1325         case ETH_LINK_FULL_DUPLEX:
1326           hw_flags |= VNET_HW_INTERFACE_FLAG_FULL_DUPLEX;
1327           break;
1328         default:
1329           break;
1330         }
1331     }
1332   if (hw_flags_chg || (xd->link.link_speed != prev_link.link_speed))
1333     {
1334       hw_flags_chg = 1;
1335       switch (xd->link.link_speed)
1336         {
1337         case ETH_SPEED_NUM_10M:
1338           hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_10M;
1339           break;
1340         case ETH_SPEED_NUM_100M:
1341           hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_100M;
1342           break;
1343         case ETH_SPEED_NUM_1G:
1344           hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_1G;
1345           break;
1346         case ETH_SPEED_NUM_10G:
1347           hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_10G;
1348           break;
1349         case ETH_SPEED_NUM_40G:
1350           hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_40G;
1351           break;
1352         case 0:
1353           break;
1354         default:
1355           clib_warning ("unknown link speed %d", xd->link.link_speed);
1356           break;
1357         }
1358     }
1359   if (hw_flags_chg)
1360     {
1361       if (LINK_STATE_ELOGS)
1362         {
1363           vlib_main_t *vm = vlib_get_main ();
1364
1365           ELOG_TYPE_DECLARE (e) =
1366           {
1367           .format =
1368               "update-link-state: sw_if_index %d, new flags %d",.format_args
1369               = "i4i4",};
1370
1371           struct
1372           {
1373             u32 sw_if_index;
1374             u32 flags;
1375           } *ed;
1376           ed = ELOG_DATA (&vm->elog_main, e);
1377           ed->sw_if_index = xd->vlib_sw_if_index;
1378           ed->flags = hw_flags;
1379         }
1380       vnet_hw_interface_set_flags (vnm, xd->hw_if_index, hw_flags);
1381     }
1382 }
1383
1384 static uword
1385 dpdk_process (vlib_main_t * vm, vlib_node_runtime_t * rt, vlib_frame_t * f)
1386 {
1387   clib_error_t *error;
1388   vnet_main_t *vnm = vnet_get_main ();
1389   dpdk_main_t *dm = &dpdk_main;
1390   ethernet_main_t *em = &ethernet_main;
1391   dpdk_device_t *xd;
1392   vlib_thread_main_t *tm = vlib_get_thread_main ();
1393   int i;
1394
1395   error = dpdk_lib_init (dm);
1396
1397   if (error)
1398     clib_error_report (error);
1399
1400   tm->worker_thread_release = 1;
1401
1402   f64 now = vlib_time_now (vm);
1403   vec_foreach (xd, dm->devices)
1404   {
1405     dpdk_update_link_state (xd, now);
1406   }
1407
1408   {
1409     /*
1410      * Extra set up for bond interfaces:
1411      *  1. Setup MACs for bond interfaces and their slave links which was set
1412      *     in dpdk_device_setup() but needs to be done again here to take
1413      *     effect.
1414      *  2. Set up info and register slave link state change callback handling.
1415      *  3. Set up info for bond interface related CLI support.
1416      */
1417     int nports = rte_eth_dev_count ();
1418     if (nports > 0)
1419       {
1420         for (i = 0; i < nports; i++)
1421           {
1422             xd = &dm->devices[i];
1423             ASSERT (i == xd->device_index);
1424             if (xd->pmd == VNET_DPDK_PMD_BOND)
1425               {
1426                 u8 addr[6];
1427                 dpdk_portid_t slink[16];
1428                 int nlink = rte_eth_bond_slaves_get (i, slink, 16);
1429                 if (nlink > 0)
1430                   {
1431                     vnet_hw_interface_t *bhi;
1432                     ethernet_interface_t *bei;
1433                     int rv;
1434
1435                     /* Get MAC of 1st slave link */
1436                     rte_eth_macaddr_get
1437                       (slink[0], (struct ether_addr *) addr);
1438
1439                     /* Set MAC of bounded interface to that of 1st slave link */
1440                     clib_warning ("Set MAC for bond port %d BondEthernet%d",
1441                                   i, xd->port_id);
1442                     rv = rte_eth_bond_mac_address_set
1443                       (i, (struct ether_addr *) addr);
1444                     if (rv)
1445                       clib_warning ("Set MAC addr failure rv=%d", rv);
1446
1447                     /* Populate MAC of bonded interface in VPP hw tables */
1448                     bhi = vnet_get_hw_interface
1449                       (vnm, dm->devices[i].hw_if_index);
1450                     bei = pool_elt_at_index
1451                       (em->interfaces, bhi->hw_instance);
1452                     clib_memcpy (bhi->hw_address, addr, 6);
1453                     clib_memcpy (bei->address, addr, 6);
1454
1455                     /* Init l3 packet size allowed on bonded interface */
1456                     bhi->max_packet_bytes = ETHERNET_MAX_PACKET_BYTES;
1457                     bhi->max_l3_packet_bytes[VLIB_RX] =
1458                       bhi->max_l3_packet_bytes[VLIB_TX] =
1459                       ETHERNET_MAX_PACKET_BYTES - sizeof (ethernet_header_t);
1460                     while (nlink >= 1)
1461                       {         /* for all slave links */
1462                         int slave = slink[--nlink];
1463                         dpdk_device_t *sdev = &dm->devices[slave];
1464                         vnet_hw_interface_t *shi;
1465                         vnet_sw_interface_t *ssi;
1466                         ethernet_interface_t *sei;
1467                         /* Add MAC to all slave links except the first one */
1468                         if (nlink)
1469                           {
1470                             clib_warning ("Add MAC for slave port %d", slave);
1471                             rv = rte_eth_dev_mac_addr_add
1472                               (slave, (struct ether_addr *) addr, 0);
1473                             if (rv)
1474                               clib_warning ("Add MAC addr failure rv=%d", rv);
1475                           }
1476                         /* Setup slave link state change callback handling */
1477                         rte_eth_dev_callback_register
1478                           (slave, RTE_ETH_EVENT_INTR_LSC,
1479                            dpdk_port_state_callback, NULL);
1480                         dpdk_device_t *sxd = &dm->devices[slave];
1481                         sxd->flags |= DPDK_DEVICE_FLAG_BOND_SLAVE;
1482                         sxd->bond_port = i;
1483                         /* Set slaves bitmap for bonded interface */
1484                         bhi->bond_info = clib_bitmap_set
1485                           (bhi->bond_info, sdev->hw_if_index, 1);
1486                         /* Set MACs and slave link flags on slave interface */
1487                         shi = vnet_get_hw_interface (vnm, sdev->hw_if_index);
1488                         ssi = vnet_get_sw_interface
1489                           (vnm, sdev->vlib_sw_if_index);
1490                         sei = pool_elt_at_index
1491                           (em->interfaces, shi->hw_instance);
1492                         shi->bond_info = VNET_HW_INTERFACE_BOND_INFO_SLAVE;
1493                         ssi->flags |= VNET_SW_INTERFACE_FLAG_BOND_SLAVE;
1494                         clib_memcpy (shi->hw_address, addr, 6);
1495                         clib_memcpy (sei->address, addr, 6);
1496                         /* Set l3 packet size allowed as the lowest of slave */
1497                         if (bhi->max_l3_packet_bytes[VLIB_RX] >
1498                             shi->max_l3_packet_bytes[VLIB_RX])
1499                           bhi->max_l3_packet_bytes[VLIB_RX] =
1500                             bhi->max_l3_packet_bytes[VLIB_TX] =
1501                             shi->max_l3_packet_bytes[VLIB_RX];
1502                         /* Set max packet size allowed as the lowest of slave */
1503                         if (bhi->max_packet_bytes > shi->max_packet_bytes)
1504                           bhi->max_packet_bytes = shi->max_packet_bytes;
1505                       }
1506                   }
1507               }
1508           }
1509       }
1510   }
1511
1512   while (1)
1513     {
1514       /*
1515        * check each time through the loop in case intervals are changed
1516        */
1517       f64 min_wait = dm->link_state_poll_interval < dm->stat_poll_interval ?
1518         dm->link_state_poll_interval : dm->stat_poll_interval;
1519
1520       vlib_process_wait_for_event_or_clock (vm, min_wait);
1521
1522       if (dm->admin_up_down_in_progress)
1523         /* skip the poll if an admin up down is in progress (on any interface) */
1524         continue;
1525
1526       vec_foreach (xd, dm->devices)
1527       {
1528         f64 now = vlib_time_now (vm);
1529         if ((now - xd->time_last_stats_update) >= dm->stat_poll_interval)
1530           dpdk_update_counters (xd, now);
1531         if ((now - xd->time_last_link_update) >= dm->link_state_poll_interval)
1532           dpdk_update_link_state (xd, now);
1533
1534       }
1535     }
1536
1537   return 0;
1538 }
1539
1540 /* *INDENT-OFF* */
1541 VLIB_REGISTER_NODE (dpdk_process_node,static) = {
1542     .function = dpdk_process,
1543     .type = VLIB_NODE_TYPE_PROCESS,
1544     .name = "dpdk-process",
1545     .process_log2_n_stack_bytes = 17,
1546 };
1547 /* *INDENT-ON* */
1548
1549 static clib_error_t *
1550 dpdk_init (vlib_main_t * vm)
1551 {
1552   dpdk_main_t *dm = &dpdk_main;
1553   clib_error_t *error = 0;
1554   vlib_thread_main_t *tm = vlib_get_thread_main ();
1555
1556   /* verify that structs are cacheline aligned */
1557   STATIC_ASSERT (offsetof (dpdk_device_t, cacheline0) == 0,
1558                  "Cache line marker must be 1st element in dpdk_device_t");
1559   STATIC_ASSERT (offsetof (dpdk_device_t, cacheline1) ==
1560                  CLIB_CACHE_LINE_BYTES,
1561                  "Data in cache line 0 is bigger than cache line size");
1562   STATIC_ASSERT (offsetof (frame_queue_trace_t, cacheline0) == 0,
1563                  "Cache line marker must be 1st element in frame_queue_trace_t");
1564
1565   dm->vlib_main = vm;
1566   dm->vnet_main = vnet_get_main ();
1567   dm->conf = &dpdk_config_main;
1568
1569   dm->conf->nchannels = 4;
1570   dm->conf->num_mbufs = dm->conf->num_mbufs ? dm->conf->num_mbufs : NB_MBUF;
1571   vec_add1 (dm->conf->eal_init_args, (u8 *) "vnet");
1572
1573   vec_validate (dm->recycle, tm->n_thread_stacks - 1);
1574
1575   /* Default vlib_buffer_t flags, DISABLES tcp/udp checksumming... */
1576   dm->buffer_flags_template =
1577     (VLIB_BUFFER_TOTAL_LENGTH_VALID | VLIB_BUFFER_EXT_HDR_VALID
1578      | VNET_BUFFER_F_L4_CHECKSUM_COMPUTED |
1579      VNET_BUFFER_F_L4_CHECKSUM_CORRECT | VNET_BUFFER_F_L2_HDR_OFFSET_VALID);
1580
1581   dm->stat_poll_interval = DPDK_STATS_POLL_INTERVAL;
1582   dm->link_state_poll_interval = DPDK_LINK_POLL_INTERVAL;
1583
1584   /* init CLI */
1585   if ((error = vlib_call_init_function (vm, dpdk_cli_init)))
1586     return error;
1587
1588   return error;
1589 }
1590
1591 VLIB_INIT_FUNCTION (dpdk_init);
1592
1593
1594 /*
1595  * fd.io coding-style-patch-verification: ON
1596  *
1597  * Local Variables:
1598  * eval: (c-set-style "gnu")
1599  * End:
1600  */