Don't stop binding pci device if write to new_id fails
[vpp.git] / vnet / vnet / devices / dpdk / 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
20 #include <vnet/ethernet/ethernet.h>
21 #include <vnet/devices/dpdk/dpdk.h>
22 #include <vlib/unix/physmem.h>
23
24 #include <stdio.h>
25 #include <stdlib.h>
26 #include <unistd.h>
27 #include <sys/stat.h>
28 #include <sys/mount.h>
29 #include <string.h>
30 #include <fcntl.h>
31
32 #include "dpdk_priv.h"
33
34 dpdk_main_t dpdk_main;
35
36 /* force linker to link functions used by vlib and declared weak */
37 void *vlib_weakly_linked_functions[] = {
38   &rte_pktmbuf_init,
39   &rte_pktmbuf_pool_init,
40 };
41
42 #define LINK_STATE_ELOGS        0
43
44 #define DEFAULT_HUGE_DIR "/run/vpp/hugepages"
45 #define VPP_RUN_DIR "/run/vpp"
46
47 /* Port configuration, mildly modified Intel app values */
48
49 static struct rte_eth_conf port_conf_template = {
50   .rxmode = {
51     .split_hdr_size = 0,
52     .header_split   = 0, /**< Header Split disabled */
53     .hw_ip_checksum = 0, /**< IP checksum offload disabled */
54     .hw_vlan_filter = 0, /**< VLAN filtering disabled */
55     .hw_strip_crc   = 1, /**< CRC stripped by hardware */
56   },
57   .txmode = {
58     .mq_mode = ETH_MQ_TX_NONE,
59   },
60 };
61
62 clib_error_t *
63 dpdk_port_setup (dpdk_main_t * dm, dpdk_device_t * xd)
64 {
65   vlib_main_t * vm = vlib_get_main();
66   vlib_buffer_main_t * bm = vm->buffer_main;
67   int rv;
68   int j;
69
70   ASSERT(os_get_cpu_number() == 0);
71
72   if (xd->admin_up) {
73     vnet_hw_interface_set_flags (dm->vnet_main, xd->vlib_hw_if_index, 0);
74     rte_eth_dev_stop (xd->device_index);
75   }
76
77   rv = rte_eth_dev_configure (xd->device_index, xd->rx_q_used,
78                               xd->tx_q_used, &xd->port_conf);
79
80   if (rv < 0)
81     return clib_error_return (0, "rte_eth_dev_configure[%d]: err %d",
82                               xd->device_index, rv);
83
84   /* Set up one TX-queue per worker thread */
85   for (j = 0; j < xd->tx_q_used; j++)
86     {
87       rv = rte_eth_tx_queue_setup(xd->device_index, j, xd->nb_tx_desc,
88                                  xd->cpu_socket, &xd->tx_conf);
89       if (rv < 0)
90         break;
91     }
92
93     if (rv < 0)
94       return clib_error_return (0, "rte_eth_tx_queue_setup[%d]: err %d",
95                                 xd->device_index, rv);
96
97   for (j = 0; j < xd->rx_q_used; j++)
98     {
99
100       rv = rte_eth_rx_queue_setup(xd->device_index, j, xd->nb_rx_desc,
101                                   xd->cpu_socket, 0,
102                                   bm->pktmbuf_pools[xd->cpu_socket_id_by_queue[j]]);
103       if (rv < 0)
104         return clib_error_return (0, "rte_eth_rx_queue_setup[%d]: err %d",
105                                   xd->device_index, rv);
106     }
107
108   if (xd->admin_up) {
109     rte_eth_dev_start (xd->device_index);
110   }
111   return 0;
112 }
113
114 static u32 dpdk_flag_change (vnet_main_t * vnm, 
115                              vnet_hw_interface_t * hi,
116                              u32 flags)
117 {
118   dpdk_main_t * dm = &dpdk_main;
119   dpdk_device_t * xd = vec_elt_at_index (dm->devices, hi->dev_instance);
120   u32 old = 0;
121
122   if (ETHERNET_INTERFACE_FLAG_CONFIG_PROMISC(flags))
123     {
124       old = xd->promisc;
125       xd->promisc = flags & ETHERNET_INTERFACE_FLAG_ACCEPT_ALL;
126       
127       if (xd->admin_up)
128         {
129           if (xd->promisc)
130             rte_eth_promiscuous_enable(xd->device_index);
131           else
132             rte_eth_promiscuous_disable(xd->device_index);
133         }
134     }
135   else if (ETHERNET_INTERFACE_FLAG_CONFIG_MTU(flags))
136     {
137       /*
138        * DAW-FIXME: The Cisco VIC firmware does not provide an api for a
139        *            driver to dynamically change the mtu.  If/when the 
140        *            VIC firmware gets fixed, then this should be removed.
141        */
142       if (xd->pmd == VNET_DPDK_PMD_VICE ||
143           xd->pmd == VNET_DPDK_PMD_ENIC)
144         {
145           struct rte_eth_dev_info dev_info;
146
147           /*
148            * Restore mtu to what has been set by CIMC in the firmware cfg.
149            */
150           rte_eth_dev_info_get(xd->device_index, &dev_info);
151           hi->max_packet_bytes = dev_info.max_rx_pktlen;
152
153           vlib_cli_output (vlib_get_main(), 
154                            "Cisco VIC mtu can only be changed "
155                            "using CIMC then rebooting the server!");
156         }
157       else
158         {
159           int rv;
160       
161           /*
162            * DAW-FIXME: The DPDK VMXNET3 driver does not currently support
163            *            multi-buffer packets.  Max out at 1518 bytes for now.
164            *
165            *            If/when the driver gets fixed, then this should be
166            *            removed.
167            */
168           if ((xd->pmd == VNET_DPDK_PMD_VMXNET3) &&
169               (hi->max_packet_bytes > 1518))
170             {
171               hi->max_packet_bytes = 1518;
172
173               vlib_cli_output (vlib_get_main(), 
174                                "VMXNET3 driver does not  support jumbo frames "
175                                "yet -- setting mtu to 1518!");
176             }
177
178           xd->port_conf.rxmode.max_rx_pkt_len = hi->max_packet_bytes;
179
180           if (xd->admin_up)
181             rte_eth_dev_stop (xd->device_index);
182
183     rv = rte_eth_dev_configure
184       (xd->device_index,
185        xd->rx_q_used,
186        xd->tx_q_used,
187        &xd->port_conf);
188
189           if (rv < 0)
190             vlib_cli_output (vlib_get_main(), 
191                              "rte_eth_dev_configure[%d]: err %d",
192                              xd->device_index, rv);
193
194           rte_eth_dev_set_mtu(xd->device_index, hi->max_packet_bytes);
195
196           if (xd->admin_up)
197             rte_eth_dev_start (xd->device_index);
198         }
199     }
200   return old;
201 }
202
203 #ifdef NETMAP
204 extern int rte_netmap_probe(void);
205 #endif
206
207 void
208 dpdk_device_lock_init(dpdk_device_t * xd)
209 {
210   int q;
211   vec_validate(xd->lockp, xd->tx_q_used - 1);
212   for (q = 0; q < xd->tx_q_used; q++)
213     {
214       xd->lockp[q] = clib_mem_alloc_aligned (CLIB_CACHE_LINE_BYTES,
215                                              CLIB_CACHE_LINE_BYTES);
216       memset ((void *) xd->lockp[q], 0, CLIB_CACHE_LINE_BYTES);
217   }
218   xd->need_txlock = 1;
219 }
220
221 void
222 dpdk_device_lock_free(dpdk_device_t * xd)
223 {
224   int q;
225
226   for (q = 0; q < vec_len(xd->lockp); q++)
227     clib_mem_free((void *) xd->lockp[q]);
228   vec_free(xd->lockp);
229   xd->lockp = 0;
230   xd->need_txlock = 0;
231 }
232
233 static clib_error_t *
234 dpdk_lib_init (dpdk_main_t * dm)
235 {
236   u32 nports;
237   u32 nb_desc = 0;
238   int i;
239   clib_error_t * error;
240   vlib_main_t * vm = vlib_get_main();
241   vlib_thread_main_t * tm = vlib_get_thread_main();
242   vnet_sw_interface_t * sw;
243   vnet_hw_interface_t * hi;
244   dpdk_device_t * xd;
245   vlib_thread_registration_t * tr;
246   uword * p;
247
248   u32 next_cpu = 0;
249   u8 af_packet_port_id = 0;
250
251   dm->input_cpu_first_index = 0;
252   dm->input_cpu_count = 1;
253
254   /* find out which cpus will be used for input */
255   p = hash_get_mem (tm->thread_registrations_by_name, "io");
256   tr = p ? (vlib_thread_registration_t *) p[0] : 0;
257
258   if (!tr || tr->count == 0)
259     {
260       /* no io threads, workers doing input */
261       p = hash_get_mem (tm->thread_registrations_by_name, "workers");
262       tr = p ? (vlib_thread_registration_t *) p[0] : 0;
263     }
264   else
265     {
266       dm->have_io_threads = 1;
267     }
268
269   if (tr && tr->count > 0)
270     {
271       dm->input_cpu_first_index = tr->first_index;
272       dm->input_cpu_count = tr->count;
273     }
274
275   vec_validate_aligned (dm->devices_by_cpu, tm->n_vlib_mains - 1,
276                         CLIB_CACHE_LINE_BYTES);
277
278   vec_validate_aligned (dm->workers, tm->n_vlib_mains - 1,
279                         CLIB_CACHE_LINE_BYTES);
280
281 #ifdef NETMAP
282   if(rte_netmap_probe() < 0)
283     return clib_error_return (0, "rte netmap probe failed");
284 #endif
285
286   nports = rte_eth_dev_count();
287   if (nports < 1) 
288     {
289       clib_warning ("DPDK drivers found no ports...");
290     }
291
292   if (CLIB_DEBUG > 0)
293     clib_warning ("DPDK drivers found %d ports...", nports);
294
295   /* 
296    * All buffers are all allocated from the same rte_mempool.
297    * Thus they all have the same number of data bytes.
298    */
299   dm->vlib_buffer_free_list_index = 
300       vlib_buffer_get_or_create_free_list (
301           vm, VLIB_BUFFER_DEFAULT_FREE_LIST_BYTES, "dpdk rx");
302
303   for (i = 0; i < nports; i++)
304     {
305       u8 addr[6];
306       int j;
307       struct rte_eth_dev_info dev_info;
308       clib_error_t * rv;
309       struct rte_eth_link l;
310
311       /* Create vnet interface */
312       vec_add2_aligned (dm->devices, xd, 1, CLIB_CACHE_LINE_BYTES);
313       xd->nb_rx_desc = DPDK_NB_RX_DESC_DEFAULT;
314       xd->nb_tx_desc = DPDK_NB_TX_DESC_DEFAULT;
315       xd->cpu_socket = (i8) rte_eth_dev_socket_id(i);
316       rte_eth_dev_info_get(i, &dev_info);
317
318       memcpy(&xd->tx_conf, &dev_info.default_txconf,
319              sizeof(struct rte_eth_txconf));
320       if (dm->no_multi_seg)
321         {
322           xd->tx_conf.txq_flags |= ETH_TXQ_FLAGS_NOMULTSEGS;
323           port_conf_template.rxmode.jumbo_frame = 0;
324         }
325       else
326         {
327           xd->tx_conf.txq_flags &= ~ETH_TXQ_FLAGS_NOMULTSEGS;
328           port_conf_template.rxmode.jumbo_frame = 1;
329         }
330
331       memcpy(&xd->port_conf, &port_conf_template, sizeof(struct rte_eth_conf));
332
333       xd->tx_q_used = clib_min(dev_info.max_tx_queues, tm->n_vlib_mains);
334
335       if (dm->max_tx_queues)
336         xd->tx_q_used = clib_min(xd->tx_q_used, dm->max_tx_queues);
337
338       if (dm->use_rss > 1 && dev_info.max_rx_queues >= dm->use_rss)
339         {
340           xd->rx_q_used = dm->use_rss;
341           xd->port_conf.rxmode.mq_mode = ETH_MQ_RX_RSS;
342           xd->port_conf.rx_adv_conf.rss_conf.rss_hf = ETH_RSS_IP | ETH_RSS_UDP | ETH_RSS_TCP;
343         }
344       else
345         xd->rx_q_used = 1;
346
347       xd->dev_type = VNET_DPDK_DEV_ETH;
348
349       /* workaround for drivers not setting driver_name */
350       if (!dev_info.driver_name)
351         dev_info.driver_name = dev_info.pci_dev->driver->name;
352       ASSERT(dev_info.driver_name);
353
354       if (!xd->pmd) {
355
356
357 #define _(s,f) else if (!strcmp(dev_info.driver_name, s)) \
358                  xd->pmd = VNET_DPDK_PMD_##f;
359         if (0)
360           ;
361         foreach_dpdk_pmd
362 #undef _
363         else
364           xd->pmd = VNET_DPDK_PMD_UNKNOWN;
365
366
367         switch (xd->pmd) {
368           /* 1G adapters */
369           case VNET_DPDK_PMD_E1000EM:
370           case VNET_DPDK_PMD_IGB:
371           case VNET_DPDK_PMD_IGBVF:
372             xd->port_type = VNET_DPDK_PORT_TYPE_ETH_1G;
373             break;
374
375           /* 10G adapters */
376           case VNET_DPDK_PMD_IXGBE:
377           case VNET_DPDK_PMD_IXGBEVF:
378           case VNET_DPDK_PMD_THUNDERX:
379             xd->port_type = VNET_DPDK_PORT_TYPE_ETH_10G;
380             xd->nb_rx_desc = DPDK_NB_RX_DESC_10GE;
381             xd->nb_tx_desc = DPDK_NB_TX_DESC_10GE;
382             break;
383
384           /* Cisco VIC */
385           case VNET_DPDK_PMD_VICE:
386           case VNET_DPDK_PMD_ENIC:
387             rte_eth_link_get_nowait(i, &l);
388             if (l.link_speed == 40000)
389               {
390                 xd->port_type = VNET_DPDK_PORT_TYPE_ETH_40G;
391                 xd->nb_rx_desc = DPDK_NB_RX_DESC_40GE;
392                 xd->nb_tx_desc = DPDK_NB_TX_DESC_40GE;
393               }
394             else
395               {
396                 xd->port_type = VNET_DPDK_PORT_TYPE_ETH_10G;
397                 xd->nb_rx_desc = DPDK_NB_RX_DESC_10GE;
398                 xd->nb_tx_desc = DPDK_NB_TX_DESC_10GE;
399               }
400             break;
401
402           /* Intel Fortville */
403           case VNET_DPDK_PMD_I40E:
404           case VNET_DPDK_PMD_I40EVF:
405             xd->port_type = VNET_DPDK_PORT_TYPE_ETH_40G;
406             xd->nb_rx_desc = DPDK_NB_RX_DESC_40GE;
407             xd->nb_tx_desc = DPDK_NB_TX_DESC_40GE;
408
409             switch (dev_info.pci_dev->id.device_id) {
410               case I40E_DEV_ID_10G_BASE_T:
411               case I40E_DEV_ID_SFP_XL710:
412                 xd->port_type = VNET_DPDK_PORT_TYPE_ETH_10G;
413                 break;
414               case I40E_DEV_ID_QSFP_A:
415               case I40E_DEV_ID_QSFP_B:
416               case I40E_DEV_ID_QSFP_C:
417                 xd->port_type = VNET_DPDK_PORT_TYPE_ETH_40G;
418                 break;
419               case I40E_DEV_ID_VF:
420                 rte_eth_link_get_nowait(i, &l);
421                 xd->port_type = l.link_speed == 10000 ?
422                   VNET_DPDK_PORT_TYPE_ETH_10G : VNET_DPDK_PORT_TYPE_ETH_40G;
423                 break;
424               default:
425                 xd->port_type = VNET_DPDK_PORT_TYPE_UNKNOWN;
426             }
427             break;
428
429           case VNET_DPDK_PMD_CXGBE:
430             switch (dev_info.pci_dev->id.device_id) {
431               case 0x5410: /* T580-LP-cr */
432                 xd->nb_rx_desc = DPDK_NB_RX_DESC_40GE;
433                 xd->nb_tx_desc = DPDK_NB_TX_DESC_40GE;
434                 xd->port_type = VNET_DPDK_PORT_TYPE_ETH_40G;
435                 break;
436               default:
437                 xd->nb_rx_desc = DPDK_NB_RX_DESC_10GE;
438                 xd->nb_tx_desc = DPDK_NB_TX_DESC_10GE;
439                 xd->port_type = VNET_DPDK_PORT_TYPE_UNKNOWN;
440             }
441             break;
442
443           /* Intel Red Rock Canyon */
444           case VNET_DPDK_PMD_FM10K:
445             xd->port_type = VNET_DPDK_PORT_TYPE_ETH_SWITCH;
446             xd->nb_rx_desc = DPDK_NB_RX_DESC_40GE;
447             xd->nb_tx_desc = DPDK_NB_TX_DESC_40GE;
448             break;
449
450           /* virtio */
451           case VNET_DPDK_PMD_VIRTIO:
452             xd->port_type = VNET_DPDK_PORT_TYPE_ETH_1G;
453             xd->nb_rx_desc = DPDK_NB_RX_DESC_VIRTIO;
454             xd->nb_tx_desc = DPDK_NB_TX_DESC_VIRTIO;
455             break;
456
457           /* vmxnet3 */
458           case VNET_DPDK_PMD_VMXNET3:
459             xd->port_type = VNET_DPDK_PORT_TYPE_ETH_1G;
460             xd->tx_conf.txq_flags |= ETH_TXQ_FLAGS_NOMULTSEGS;
461             break;
462
463           case VNET_DPDK_PMD_AF_PACKET:
464             xd->port_type = VNET_DPDK_PORT_TYPE_AF_PACKET;
465             xd->af_packet_port_id = af_packet_port_id++;
466             break;
467
468           case VNET_DPDK_PMD_BOND:
469             xd->port_type = VNET_DPDK_PORT_TYPE_ETH_BOND;
470             break;
471
472           default:
473             xd->port_type = VNET_DPDK_PORT_TYPE_UNKNOWN;
474         }
475
476   #ifdef NETMAP
477         if(strncmp(dev_info.driver_name, "vale", 4) == 0
478              || strncmp(dev_info.driver_name, "netmap", 6) == 0)
479           {
480             xd->pmd = VNET_DPDK_PMD_NETMAP;
481             xd->port_type = VNET_DPDK_PORT_TYPE_NETMAP;
482           }
483   #endif
484
485       }
486
487       /*
488        * Ensure default mtu is not > the mtu read from the hardware.
489        * Otherwise rte_eth_dev_configure() will fail and the port will
490        * not be available.
491        */
492       xd->port_conf.rxmode.max_rx_pkt_len = 
493               (ETHERNET_MAX_PACKET_BYTES > dev_info.max_rx_pktlen) ? 
494               dev_info.max_rx_pktlen : ETHERNET_MAX_PACKET_BYTES;
495
496       /*
497        * DAW-FIXME: VMXNET3 driver doesn't support jumbo / multi-buffer pkts
498        */
499       if (xd->pmd == VNET_DPDK_PMD_VMXNET3)
500         {
501           xd->port_conf.rxmode.max_rx_pkt_len = 1518;
502           xd->port_conf.rxmode.jumbo_frame = 0;
503         }
504
505       if (xd->pmd == VNET_DPDK_PMD_AF_PACKET)
506         {
507           f64 now = vlib_time_now(vm);
508           u32 rnd;
509           rnd = (u32) (now * 1e6);
510           rnd = random_u32 (&rnd);
511           memcpy (addr+2, &rnd, sizeof(rnd));
512           addr[0] = 2;
513           addr[1] = 0xfe;
514         }
515       else
516         rte_eth_macaddr_get(i,(struct ether_addr *)addr);
517
518       if (xd->tx_q_used < tm->n_vlib_mains)
519         dpdk_device_lock_init(xd);
520
521       xd->device_index = xd - dm->devices;
522       ASSERT(i == xd->device_index);
523       xd->per_interface_next_index = ~0;
524
525       /* assign interface to input thread */
526       dpdk_device_and_queue_t * dq;
527       int q;
528
529       for (q = 0; q < xd->rx_q_used; q++)
530         {
531           int cpu = dm->input_cpu_first_index + next_cpu;
532           unsigned lcore = vlib_worker_threads[cpu].dpdk_lcore_id;
533
534           /*
535            * numa node for worker thread handling this queue
536            * needed for taking buffers from the right mempool
537            */
538           vec_validate(xd->cpu_socket_id_by_queue, q);
539           xd->cpu_socket_id_by_queue[q] = rte_lcore_to_socket_id(lcore);
540
541           /*
542            * construct vector of (device,queue) pairs for each worker thread
543            */
544           vec_add2(dm->devices_by_cpu[cpu], dq, 1);
545           dq->device = xd->device_index;
546           dq->queue_id = q;
547
548           next_cpu++;
549           if (next_cpu == dm->input_cpu_count)
550             next_cpu = 0;
551         }
552
553       vec_validate_aligned (xd->tx_vectors, tm->n_vlib_mains,
554                             CLIB_CACHE_LINE_BYTES);
555       for (j = 0; j < tm->n_vlib_mains; j++)
556         {
557           vec_validate_ha (xd->tx_vectors[j], DPDK_TX_RING_SIZE, 
558                            sizeof(tx_ring_hdr_t), CLIB_CACHE_LINE_BYTES);
559           vec_reset_length (xd->tx_vectors[j]);
560         }
561
562       vec_validate_aligned (xd->rx_vectors, xd->rx_q_used,
563                             CLIB_CACHE_LINE_BYTES);
564       for (j = 0; j< xd->rx_q_used; j++)
565         {
566           vec_validate_aligned (xd->rx_vectors[j], VLIB_FRAME_SIZE-1,
567                                 CLIB_CACHE_LINE_BYTES);
568           vec_reset_length (xd->rx_vectors[j]);
569         }
570
571       vec_validate_aligned (xd->frames, tm->n_vlib_mains,
572                             CLIB_CACHE_LINE_BYTES);
573
574       rv = dpdk_port_setup(dm, xd);
575
576       if (rv < 0)
577         return rv;
578
579       /* count the number of descriptors used for this device */
580       nb_desc += xd->nb_rx_desc + xd->nb_tx_desc * xd->tx_q_used;
581
582       error = ethernet_register_interface
583         (dm->vnet_main,
584          dpdk_device_class.index,
585          xd->device_index,
586          /* ethernet address */ addr,
587          &xd->vlib_hw_if_index, 
588          dpdk_flag_change);
589       if (error)
590         return error;
591       
592       sw = vnet_get_hw_sw_interface (dm->vnet_main, xd->vlib_hw_if_index);
593       xd->vlib_sw_if_index = sw->sw_if_index;
594       hi = vnet_get_hw_interface (dm->vnet_main, xd->vlib_hw_if_index);
595
596       /*
597        * DAW-FIXME: The Cisco VIC firmware does not provide an api for a
598        *            driver to dynamically change the mtu.  If/when the 
599        *            VIC firmware gets fixed, then this should be removed.
600        */
601       if (xd->pmd == VNET_DPDK_PMD_VICE ||
602           xd->pmd == VNET_DPDK_PMD_ENIC)
603         {
604           /*
605            * Initialize mtu to what has been set by CIMC in the firmware cfg.
606            */
607           hi->max_packet_bytes = dev_info.max_rx_pktlen;
608           /*
609            * remove vlan tag from VIC port to fix VLAN0 issue.
610            * TODO Handle VLAN tagged traffic
611            */
612           int vlan_off;
613           vlan_off = rte_eth_dev_get_vlan_offload(xd->device_index);
614           vlan_off |= ETH_VLAN_STRIP_OFFLOAD;
615           rte_eth_dev_set_vlan_offload(xd->device_index, vlan_off);
616         }
617       /*
618        * DAW-FIXME: VMXNET3 driver doesn't support jumbo / multi-buffer pkts
619        */
620       else if (xd->pmd == VNET_DPDK_PMD_VMXNET3)
621           hi->max_packet_bytes = 1518;
622
623       hi->max_l3_packet_bytes[VLIB_RX] = hi->max_l3_packet_bytes[VLIB_TX] = 
624               xd->port_conf.rxmode.max_rx_pkt_len - sizeof(ethernet_header_t);
625
626      rte_eth_dev_set_mtu(xd->device_index, hi->max_packet_bytes);
627     }
628
629 #ifdef RTE_LIBRTE_KNI
630   if (dm->num_kni) {
631     clib_warning("Initializing KNI interfaces...");
632     rte_kni_init(dm->num_kni);
633     for (i = 0; i < dm->num_kni; i++)
634     {
635       u8 addr[6];
636       int j;
637
638       /* Create vnet interface */
639       vec_add2_aligned (dm->devices, xd, 1, CLIB_CACHE_LINE_BYTES);
640       xd->dev_type = VNET_DPDK_DEV_KNI;
641
642       xd->device_index = xd - dm->devices;
643       ASSERT(nports + i == xd->device_index);
644       xd->per_interface_next_index = ~0;
645       xd->kni_port_id = i;
646       xd->cpu_socket = -1;
647       hash_set (dm->dpdk_device_by_kni_port_id, i, xd - dm->devices);
648       xd->rx_q_used = 1;
649
650       /* assign interface to input thread */
651       dpdk_device_and_queue_t * dq;
652       vec_add2(dm->devices_by_cpu[dm->input_cpu_first_index], dq, 1);
653       dq->device = xd->device_index;
654       dq->queue_id = 0;
655
656       vec_validate_aligned (xd->tx_vectors, tm->n_vlib_mains,
657                             CLIB_CACHE_LINE_BYTES);
658       for (j = 0; j < tm->n_vlib_mains; j++)
659         {
660           vec_validate_ha (xd->tx_vectors[j], DPDK_TX_RING_SIZE, 
661                            sizeof(tx_ring_hdr_t), CLIB_CACHE_LINE_BYTES);
662           vec_reset_length (xd->tx_vectors[j]);
663         }
664
665       vec_validate_aligned (xd->rx_vectors, xd->rx_q_used,
666                             CLIB_CACHE_LINE_BYTES);
667       for (j = 0; j< xd->rx_q_used; j++)
668         {
669           vec_validate_aligned (xd->rx_vectors[j], VLIB_FRAME_SIZE-1,
670                                 CLIB_CACHE_LINE_BYTES);
671           vec_reset_length (xd->rx_vectors[j]);
672         }
673
674       vec_validate_aligned (xd->frames, tm->n_vlib_mains,
675                             CLIB_CACHE_LINE_BYTES);
676
677       /* FIXME Set up one TX-queue per worker thread */
678
679       {
680         f64 now = vlib_time_now(vm);
681         u32 rnd;
682         rnd = (u32) (now * 1e6);
683         rnd = random_u32 (&rnd);
684
685         memcpy (addr+2, &rnd, sizeof(rnd));
686         addr[0] = 2;
687         addr[1] = 0xfe;
688       }
689
690       error = ethernet_register_interface
691         (dm->vnet_main,
692          dpdk_device_class.index,
693          xd->device_index,
694          /* ethernet address */ addr,
695          &xd->vlib_hw_if_index, 
696          dpdk_flag_change);
697
698       if (error)
699         return error;
700
701       sw = vnet_get_hw_sw_interface (dm->vnet_main, xd->vlib_hw_if_index);
702       xd->vlib_sw_if_index = sw->sw_if_index;
703       hi = vnet_get_hw_interface (dm->vnet_main, xd->vlib_hw_if_index);
704     }
705   }
706 #endif
707
708   if (nb_desc > dm->num_mbufs) 
709     clib_warning ("%d mbufs allocated but total rx/tx ring size is %d\n",
710                   dm->num_mbufs, nb_desc);
711
712   /* init next vhost-user if index */
713   dm->next_vu_if_id = 0;
714
715   return 0;
716 }
717
718 static clib_error_t *
719 write_sys_fs (char * file_name, char * fmt, ...)
720 {
721   u8 * s;
722   int fd;
723
724   fd = open (file_name, O_WRONLY);
725   if (fd < 0)
726     return clib_error_return_unix (0, "open `%s'", file_name);
727
728   va_list va;
729   va_start (va, fmt);
730   s = va_format (0, fmt, &va);
731   va_end (va);
732   vec_add1 (s, 0); // terminate c string
733
734   if (write (fd, s, vec_len (s)) < 0)
735       return clib_error_return_unix (0, "write '%s' to '%s'", s, file_name);
736
737   vec_free (s);
738   close (fd);
739   return 0;
740 }
741
742 #define VIRTIO_PCI_NAME  "virtio-pci"
743
744 static clib_error_t * dpdk_bind_eth_kernel_drivers (vlib_main_t * vm,
745                                                     char * pci_dev_id,
746                                                     char * kernel_driver)
747 {
748   dpdk_main_t * dm = &dpdk_main;
749   unformat_input_t _in;
750   unformat_input_t * in = &_in;
751   clib_error_t * error = 0;
752   u8 * line = 0, * modcmd = 0, * path = 0;
753   u8 * pci_vid = 0, *pci_did = 0, * devname = 0;
754   char *driver_name = kernel_driver;
755   FILE * fp;
756
757   /* 
758    * Bail out now if we're not running as root.
759    * This allows non-privileged use of the packet generator, etc.
760    */
761   if (geteuid() != 0)
762     return 0;
763
764   /*
765    * Get all ethernet pci device numbers for the device type specified.
766    */
767   modcmd = format (0, "lspci -nDd %s | grep 0200 | "
768                    "awk '{ print $1, $3 }'%c", pci_dev_id, 0);
769   if ((fp = popen ((const char *)modcmd, "r")) == NULL)
770     {
771       error = clib_error_return_unix (0, 
772                                       "Unable to get %s ethernet pci devices.",
773                                       pci_dev_id);
774       goto done;
775     }
776
777   vec_validate (line, BUFSIZ);
778   vec_validate (path, BUFSIZ);
779   while (fgets ((char *)line, BUFSIZ, fp) != NULL)
780     {
781       struct stat st;
782       u8 bind_uio = 1;
783       line[strlen ((char *)line) - 1] = 0; // chomp trailing newline.
784
785       unformat_init_string (in, (char *)line, strlen((char *)line) + 1);
786       unformat(in, "%s %s:%s", &devname, &pci_vid, &pci_did);
787       unformat_free (in);
788
789       /*
790        * Blacklist all ethernet interfaces in the 
791        * linux IP routing tables (route --inet --inet6)
792        */
793       if (strstr ((char *)dm->eth_if_blacklist, (char *)devname))
794         continue;
795
796       /*
797        * If there are any devices whitelisted, then blacklist all devices
798        * which are not explicitly whitelisted.
799        */
800       if (dm->eth_if_whitelist && 
801           !strstr ((char *)dm->eth_if_whitelist, (char *)devname))
802         continue;
803
804 #ifdef NETMAP
805       /*
806        * Optimistically open the device as a netmap device.
807        */
808       if (eth_nm_open((char *)devname))
809         continue;
810 #endif
811
812       _vec_len (path) = 0;
813       path = format (path, "/sys/bus/pci/devices/%s/driver/unbind%c",
814                      devname, 0);
815
816       /*
817        * If the device is bound to a driver...
818        */
819       if (stat ((const char *)path, &st) == 0)
820         {
821           u8 * device_path;
822
823           /*
824            * If the interface is not a virtio...
825            */
826          if (!driver_name || strcmp(driver_name, VIRTIO_PCI_NAME))
827            {
828               /*
829                * If it is already bound to driver, don't unbind/bind it.
830                */
831               device_path = format (0, "/sys/bus/pci/drivers/%s/%s/device%c",
832                                     driver_name, devname, 0);
833               if (stat ((const char *)device_path, &st) == 0)
834                 bind_uio = 0;
835
836               vec_free (device_path);
837            }
838           
839           /*
840            * unbind it from the current driver
841            */
842           if (bind_uio)
843             {
844               _vec_len (path) -= 1;
845               path = format (path, "%c", 0);
846               error = write_sys_fs ((char *)path, "%s", devname);
847               if (error)
848                 goto done;
849             }
850         }
851
852       /*
853        * DAW-FIXME: The following bind/unbind dance is necessary for the dpdk
854        *            virtio poll-mode driver to work.  
855        */
856  
857       if (driver_name && !strcmp(driver_name, VIRTIO_PCI_NAME))
858         {
859           /*
860            * bind interface to the native kernel module
861            */
862           _vec_len (path) = 0;
863           path = format (path, "/sys/bus/pci/drivers/%s/bind%c",
864                          driver_name, 0);
865           error = write_sys_fs ((char *)path, "%s", devname);
866           if (error)
867             goto done;
868
869           /*
870            * unbind interface from the native kernel module
871            */
872           _vec_len (path) -= 5;
873           path = format (path, "unbind%c", 0);
874           error = write_sys_fs ((char *)path, "%s", devname);
875           if (error)
876             goto done;
877         }
878
879       /*
880        * bind the interface to igb_uio
881        */
882       if (bind_uio)
883         {
884           _vec_len (path) = 0;
885           path = format (path, "/sys/bus/pci/drivers/%s/new_id%c", driver_name, 0);
886           error = write_sys_fs ((char *) path, "%s %s", pci_vid, pci_did);
887
888           _vec_len (path) = 0;
889           path = format (path, "/sys/bus/pci/drivers/%s/bind%c", driver_name, 0);
890           error = write_sys_fs ((char *) path, "%s", devname);
891           if (error)
892             {
893               error = 0;
894               continue;
895             }
896         }
897     }
898   
899  done:
900   vec_free (line);
901   vec_free (path);
902   vec_free (devname);
903   vec_free (pci_vid);
904   vec_free (pci_did);
905   vec_free (modcmd);
906   pclose (fp);
907   return error;
908 }
909
910 static u32
911 get_node_free_hugepages_num (u32 node, u32 page_size)
912 {
913   FILE * fp;
914   u8 * tmp;
915
916   tmp = format (0, "/sys/devices/system/node/node%u/hugepages/hugepages-%ukB/"
917                 "free_hugepages%c", node, page_size, 0);
918   fp = fopen ((char *) tmp, "r");
919   vec_free(tmp);
920
921   if (fp != NULL)
922     {
923       u8 * buffer = 0;
924       u32 pages_avail = 0;
925
926       vec_validate (buffer, 256-1);
927       if (fgets ((char *)buffer, 256, fp))
928         {
929           unformat_input_t in;
930           unformat_init_string (&in, (char *) buffer, strlen ((char *) buffer));
931           unformat(&in, "%u", &pages_avail);
932           unformat_free (&in);
933         }
934       vec_free(buffer);
935       fclose(fp);
936       return pages_avail;
937     }
938
939   return 0;
940 }
941
942 static clib_error_t *
943 dpdk_config (vlib_main_t * vm, unformat_input_t * input)
944 {
945   clib_error_t * error = 0;
946   dpdk_main_t * dm = &dpdk_main;
947   vlib_thread_main_t * tm = vlib_get_thread_main();
948   u8 * s, * tmp = 0;
949   u8 * pci_dev_id = 0;
950   u8 * rte_cmd = 0, * ethname = 0;
951   FILE * rte_fp;
952   u32 log_level;
953   int ret, i;
954   char * fmt;
955 #ifdef NETMAP
956   int rxrings, txrings, rxslots, txslots, txburst;
957   char * nmnam;
958 #endif
959   unformat_input_t _in;
960   unformat_input_t * in = &_in;
961   u8 no_pci = 0;
962   u8 no_huge = 0;
963   u8 huge_dir = 0;
964   u8 file_prefix = 0;
965   u8 * socket_mem = 0;
966
967   // MATT-FIXME: inverted virtio-vhost logic to use virtio by default
968   dm->use_virtio_vhost = 1;
969
970   while (unformat_check_input(input) != UNFORMAT_END_OF_INPUT)
971     {
972       /* Prime the pump */
973       if (unformat (input, "no-hugetlb"))
974         {
975           vec_add1 (dm->eal_init_args, (u8 *) "no-huge");
976           no_huge = 1;
977         }
978
979       else if (unformat (input, "enable-tcp-udp-checksum"))
980         {
981           dm->buffer_flags_template &= 
982             ~(IP_BUFFER_L4_CHECKSUM_CORRECT | IP_BUFFER_L4_CHECKSUM_COMPUTED);
983         }
984
985       else if (unformat (input, "decimal-interface-names"))
986         dm->interface_name_format_decimal = 1;
987
988       else if (unformat (input, "no-multi-seg"))
989         dm->no_multi_seg = 1;
990
991       else if (unformat (input, "dev %s", &pci_dev_id))
992         {
993           if (dm->eth_if_whitelist)
994             {
995               /*
996                * Don't add duplicate device id's.
997                */
998               if (strstr ((char *)dm->eth_if_whitelist, (char *)pci_dev_id))
999                 continue;
1000
1001               _vec_len (dm->eth_if_whitelist) -= 1; // chomp trailing NULL.
1002               dm->eth_if_whitelist = format (dm->eth_if_whitelist, " %s%c",
1003                                              pci_dev_id, 0);
1004             }
1005           else
1006             dm->eth_if_whitelist = format (0, "%s%c", pci_dev_id, 0);
1007         }
1008
1009 #ifdef NETMAP
1010      else if (unformat(input, "netmap %s/%d:%d/%d:%d/%d",
1011                   &nmname, &rxrings, &rxslots, &txrings, &txslots, &txburst)) {
1012         char * rv;
1013         rv = (char *)
1014           eth_nm_args(nmname, rxrings, rxslots, txrings, txslots, txburst);
1015         if (rv) {
1016           error = clib_error_return (0, "%s", rv);
1017           goto done;
1018         }
1019       }else if (unformat(input, "netmap %s", &nmname)) {
1020         char * rv;
1021         rv = (char *)
1022           eth_nm_args(nmname, 0, 0, 0, 0, 0);
1023         if (rv) {
1024           error = clib_error_return (0, "%s", rv);
1025           goto done;
1026         }
1027       }
1028 #endif
1029
1030       else if (unformat (input, "num-mbufs %d", &dm->num_mbufs))
1031         ;
1032       else if (unformat (input, "max-tx-queues %d", &dm->max_tx_queues))
1033         ;
1034       else if (unformat (input, "kni %d", &dm->num_kni))
1035         ;
1036       else if (unformat (input, "uio-driver %s", &dm->uio_driver_name))
1037         ;
1038       else if (unformat (input, "vhost-user-coalesce-frames %d", &dm->vhost_coalesce_frames))
1039         ;
1040       else if (unformat (input, "vhost-user-coalesce-time %f", &dm->vhost_coalesce_time))
1041         ;
1042       else if (unformat (input, "enable-vhost-user"))
1043         dm->use_virtio_vhost = 0;
1044       else if (unformat (input, "rss %d", &dm->use_rss))
1045         ;
1046
1047 #define _(a)                                    \
1048       else if (unformat(input, #a))             \
1049         {                                       \
1050           if (!strncmp(#a, "no-pci", 6))        \
1051             no_pci = 1;                         \
1052           tmp = format (0, "--%s%c", #a, 0);    \
1053           vec_add1 (dm->eal_init_args, tmp);    \
1054         }
1055       foreach_eal_double_hyphen_predicate_arg
1056 #undef _
1057
1058 #define _(a)                                          \
1059         else if (unformat(input, #a " %s", &s))       \
1060           {                                           \
1061             if (!strncmp(#a, "huge-dir", 8))          \
1062               huge_dir = 1;                           \
1063             else if (!strncmp(#a, "file-prefix", 11)) \
1064               file_prefix = 1;                        \
1065             else if (!strncmp(#a, "socket-mem", 10))  \
1066               socket_mem = vec_dup (s);               \
1067             tmp = format (0, "--%s%c", #a, 0);        \
1068             vec_add1 (dm->eal_init_args, tmp);        \
1069             vec_add1 (s, 0);                          \
1070             vec_add1 (dm->eal_init_args, s);          \
1071           }
1072         foreach_eal_double_hyphen_arg
1073 #undef _
1074
1075 #define _(a,b)                                          \
1076           else if (unformat(input, #a " %s", &s))       \
1077             {                                           \
1078               tmp = format (0, "-%s%c", #b, 0);         \
1079               vec_add1 (dm->eal_init_args, tmp);        \
1080               vec_add1 (s, 0);                          \
1081               vec_add1 (dm->eal_init_args, s);          \
1082             }
1083           foreach_eal_single_hyphen_arg
1084 #undef _
1085
1086 #define _(a,b)                                          \
1087             else if (unformat(input, #a " %s", &s))     \
1088               {                                         \
1089                 tmp = format (0, "-%s%c", #b, 0);       \
1090                 vec_add1 (dm->eal_init_args, tmp);      \
1091                 vec_add1 (s, 0);                        \
1092                 vec_add1 (dm->eal_init_args, s);        \
1093                 dm->a##_set_manually = 1;               \
1094               }
1095             foreach_eal_single_hyphen_mandatory_arg
1096 #undef _
1097
1098           else if (unformat(input, "default"))
1099             ;
1100
1101           else
1102             {
1103               error = clib_error_return (0, "unknown input `%U'",
1104                                          format_unformat_error, input);
1105               goto done;
1106             }
1107     }
1108
1109   if (!dm->uio_driver_name)
1110     dm->uio_driver_name = format (0, "igb_uio");
1111
1112   /*
1113    * Use 1G huge pages if available.
1114    */
1115   if (!no_huge && !huge_dir)
1116     {
1117       uword * mem_by_socket = hash_create (0, sizeof (uword));
1118       uword c;
1119       u8 use_1g = 1;
1120       u8 use_2m = 1;
1121       int rv;
1122
1123       umount(DEFAULT_HUGE_DIR);
1124
1125       /* Process "socket-mem" parameter value */
1126       if (vec_len (socket_mem))
1127         {
1128           unformat_input_t in;
1129           unformat_init_vector(&in, socket_mem);
1130           unformat(&in, "%U", unformat_socket_mem, &mem_by_socket);
1131           unformat_free(&in);
1132         }
1133       else
1134         use_1g = 0;
1135
1136       /* check if available enough 1GB pages for each socket */
1137       clib_bitmap_foreach (c, tm->cpu_socket_bitmap, ({
1138          uword * p = hash_get (mem_by_socket, c);
1139          if (p)
1140            {
1141              u32 mem = p[0];
1142              if (mem)
1143                {
1144                  u32 pages_num_1g = mem / 1024;
1145                  u32 pages_num_2m = mem / 2;
1146                  u32 pages_avail;
1147
1148                  pages_avail = get_node_free_hugepages_num(c, 1048576);
1149                  if (!pages_avail || !(pages_avail >= pages_num_1g))
1150                    use_1g = 0;
1151
1152                  pages_avail = get_node_free_hugepages_num(c, 2048);
1153                  if (!pages_avail || !(pages_avail >= pages_num_2m))
1154                    use_2m = 0;
1155               }
1156            }
1157       }));
1158
1159       hash_free (mem_by_socket);
1160
1161       rv = mkdir(VPP_RUN_DIR, 0755);
1162       if (rv && errno != EEXIST)
1163         {
1164           error = clib_error_return (0, "mkdir '%s' failed errno %d",
1165                                      VPP_RUN_DIR, errno);
1166           goto done;
1167         }
1168
1169       rv = mkdir(DEFAULT_HUGE_DIR, 0755);
1170       if (rv && errno != EEXIST)
1171         {
1172           error = clib_error_return (0, "mkdir '%s' failed errno %d",
1173                                      DEFAULT_HUGE_DIR, errno);
1174           goto done;
1175         }
1176
1177       if (use_1g)
1178         {
1179           rv = mount("none", DEFAULT_HUGE_DIR, "hugetlbfs", 0, "pagesize=1G");
1180         }
1181       else if (use_2m)
1182         {
1183           rv = mount("none", DEFAULT_HUGE_DIR, "hugetlbfs", 0, NULL);
1184         }
1185       else
1186         {
1187           return clib_error_return (0, "not enough free huge pages");
1188         }
1189
1190       if (rv)
1191         {
1192           error = clib_error_return (0, "mount failed %d", errno);
1193           goto done;
1194         }
1195
1196       tmp = format (0, "--huge-dir%c", 0);
1197       vec_add1 (dm->eal_init_args, tmp);
1198       tmp = format (0, "%s%c", DEFAULT_HUGE_DIR, 0);
1199       vec_add1 (dm->eal_init_args, tmp);
1200       if (!file_prefix)
1201         {
1202           tmp = format (0, "--file-prefix%c", 0);
1203           vec_add1 (dm->eal_init_args, tmp);
1204           tmp = format (0, "vpp%c", 0);
1205           vec_add1 (dm->eal_init_args, tmp);
1206         }
1207     }
1208
1209   /*
1210    * Blacklist all ethernet interfaces in the linux IP routing tables.
1211    */
1212   dm->eth_if_blacklist = format (0, "%c", 0);
1213   rte_cmd = format (0, "route --inet --inet6 -n|awk '{print $7}'|sort -u|"
1214                     "egrep $(echo $(ls -1d /sys/class/net/*/device|"
1215                     "cut -d/ -f5)|sed -s 's/ /|/g')%c", 0);
1216   if ((rte_fp = popen ((const char *)rte_cmd, "r")) == NULL)
1217     {
1218       error = clib_error_return_unix (0, "Unable to find blacklist ethernet"
1219                                       " interface(s) in linux routing tables.");
1220       goto rte_cmd_err;
1221
1222     }
1223
1224   vec_validate (ethname, BUFSIZ);
1225   while (fgets ((char *)ethname, BUFSIZ, rte_fp) != NULL)
1226     {
1227       FILE *rlnk_fp;
1228       u8 * rlnk_cmd = 0, * devname = 0;
1229
1230       ethname[strlen ((char *)ethname) - 1] = 0; // chomp trailing newline.
1231
1232       rlnk_cmd = format (0, "readlink /sys/class/net/%s%c",
1233                          ethname, 0);
1234
1235       if ((rlnk_fp = popen ((const char *)rlnk_cmd, "r")) == NULL)
1236         {
1237           error = clib_error_return_unix (0, "Unable to read %s link.",
1238                                           ethname);
1239           goto rlnk_cmd_err;
1240         }
1241
1242       vec_validate (devname, BUFSIZ);
1243       while (fgets ((char *)devname, BUFSIZ, rlnk_fp) != NULL)
1244         {
1245           char * pci_id = 0;
1246           
1247           /*
1248            * Extract the device PCI ID name from the link. It is the first
1249            * PCI ID searching backwards from the end of the link pathname.
1250            * For example:
1251            *     readlink /sys/class/net/eth0
1252            *     ../../devices/pci0000:00/0000:00:0a.0/virtio4/net/eth0
1253            */
1254           for (pci_id = (char *)((devname + strlen((char *)devname)));
1255                ((u8 *)pci_id > devname) && *pci_id != '.'; pci_id--)
1256             ;
1257
1258           /*
1259            * Verify that the field found is a valid PCI ID.
1260            */
1261           if ((*(pci_id - 1) == '.') || ((u8 *)(pci_id - 11) < devname) || 
1262               (*(pci_id - 11) != '/') || (*(pci_id - 3) != ':') ||
1263               (*(pci_id - 6) != ':'))
1264             {
1265               devname[strlen ((char *)devname) - 1] = 0; // chomp trailing newline.
1266               clib_warning ("Unable to extract %s PCI ID (0x%llx \"%s\") "
1267                             "from 0x%llx \"%s\"", ethname, pci_id, pci_id,
1268                             devname, devname);
1269               continue;
1270             }
1271
1272           pci_id[2] = 0;
1273           pci_id -= 10;
1274
1275           /* Don't blacklist any interfaces which have been whitelisted.
1276            */
1277           if (dm->eth_if_whitelist &&
1278               strstr ((char *)dm->eth_if_whitelist, (char *)pci_id))
1279               continue;
1280
1281           _vec_len (dm->eth_if_blacklist) -= 1; // chomp trailing NULL.
1282           dm->eth_if_blacklist = format (dm->eth_if_blacklist, " %s%c",
1283                                          pci_id, 0);
1284         }
1285   
1286     rlnk_cmd_err:
1287       pclose (rlnk_fp);
1288       vec_free (rlnk_cmd);
1289       vec_free (devname);
1290     }
1291
1292  rte_cmd_err:
1293   pclose (rte_fp);
1294   vec_free (rte_cmd);
1295   vec_free (ethname);
1296
1297   if (error)
1298     return error;
1299
1300   /* I'll bet that -c and -n must be the first and second args... */
1301   if (!dm->coremask_set_manually)
1302     {
1303       vlib_thread_registration_t * tr;
1304       uword * coremask = 0;
1305       int i;
1306
1307       /* main thread core */
1308       coremask = clib_bitmap_set(coremask, tm->main_lcore, 1);
1309
1310       for (i = 0; i < vec_len (tm->registrations); i++)
1311         {
1312           tr = tm->registrations[i];
1313           coremask = clib_bitmap_or(coremask, tr->coremask);
1314         }
1315
1316       vec_insert (dm->eal_init_args, 2, 1);
1317       dm->eal_init_args[1] = (u8 *) "-c";
1318       tmp = format (0, "%U%c", format_bitmap_hex, coremask, 0);
1319       dm->eal_init_args[2] = tmp;
1320       clib_bitmap_free(coremask);
1321     }
1322
1323   if (!dm->nchannels_set_manually)
1324     {
1325       vec_insert (dm->eal_init_args, 2, 3);
1326       dm->eal_init_args[3] = (u8 *) "-n";
1327       tmp = format (0, "%d", dm->nchannels);
1328       dm->eal_init_args[4] = tmp;
1329     }
1330
1331   /*
1332    * If there are whitelisted devices,
1333    * add the whitelist option & device list to the dpdk arg list...
1334    */
1335   if (dm->eth_if_whitelist)
1336     {
1337       unformat_init_string (in, (char *)dm->eth_if_whitelist,
1338                             vec_len(dm->eth_if_whitelist) - 1);
1339       fmt = "-w%c";
1340     }
1341
1342   /*
1343    * Otherwise add the blacklisted devices to the dpdk arg list.
1344    */
1345   else
1346     {
1347       unformat_init_string (in, (char *)dm->eth_if_blacklist,
1348                             vec_len(dm->eth_if_blacklist) - 1);
1349       fmt = "-b%c";
1350     }
1351
1352   while (unformat_check_input (in) != UNFORMAT_END_OF_INPUT)
1353     {
1354       tmp = format (0, fmt, 0);
1355       vec_add1 (dm->eal_init_args, tmp);
1356       unformat (in, "%s", &pci_dev_id);
1357       vec_add1 (dm->eal_init_args, pci_dev_id);
1358     }
1359
1360   if (no_pci == 0)
1361     {
1362       /*
1363        * Bind Virtio pci devices to the igb_uio kernel driver.
1364        */
1365       error = dpdk_bind_eth_kernel_drivers (vm, "1af4:1000", VIRTIO_PCI_NAME);
1366       if (error)
1367         return error;
1368
1369       /*
1370        * Bind vmxnet3 pci devices to the igb_uio kernel driver.
1371        */
1372       error = dpdk_bind_eth_kernel_drivers (vm, "15ad:07b0",
1373                                             (char *) dm->uio_driver_name);
1374       if (error)
1375         return error;
1376
1377       /*
1378        * Bind Intel ethernet pci devices to igb_uio kernel driver.
1379        */
1380       error = dpdk_bind_eth_kernel_drivers (vm, "8086:",
1381                                             (char *) dm->uio_driver_name);
1382       /*
1383        * Bind Cisco VIC ethernet pci devices to igb_uio kernel driver.
1384        */
1385       error = dpdk_bind_eth_kernel_drivers (vm, "1137:0043",
1386                                             (char *) dm->uio_driver_name);
1387     }
1388
1389   /* set master-lcore */
1390   tmp = format (0, "--master-lcore%c", 0);
1391   vec_add1 (dm->eal_init_args, tmp);
1392   tmp = format (0, "%u%c", tm->main_lcore, 0);
1393   vec_add1 (dm->eal_init_args, tmp);
1394
1395   /* NULL terminate the "argv" vector, in case of stupidity */
1396   vec_add1 (dm->eal_init_args, 0);
1397   _vec_len(dm->eal_init_args) -= 1;
1398
1399   /* Set up DPDK eal and packet mbuf pool early. */
1400
1401   log_level = (CLIB_DEBUG > 0) ? RTE_LOG_DEBUG : RTE_LOG_NOTICE;
1402
1403   rte_set_log_level (log_level);
1404
1405   vm = dm->vlib_main;
1406
1407   /* make copy of args as rte_eal_init tends to mess up with arg array */
1408   for (i = 1; i < vec_len(dm->eal_init_args); i++)
1409     dm->eal_init_args_str = format(dm->eal_init_args_str, "%s ",
1410                                    dm->eal_init_args[i]);
1411
1412   ret = rte_eal_init(vec_len(dm->eal_init_args), (char **) dm->eal_init_args);
1413
1414   /* lazy umount hugepages */
1415   umount2(DEFAULT_HUGE_DIR, MNT_DETACH);
1416
1417   if (ret < 0)
1418     return clib_error_return (0, "rte_eal_init returned %d", ret);
1419
1420   /* Dump the physical memory layout prior to creating the mbuf_pool */
1421   fprintf(stdout, "DPDK physical memory layout:\n");
1422   rte_dump_physmem_layout(stdout);
1423
1424   /* main thread 1st */
1425   error = vlib_buffer_pool_create(vm, dm->num_mbufs, MBUF_SIZE, rte_socket_id());
1426   if (error)
1427     return error;
1428
1429   for (i = 0; i < RTE_MAX_LCORE; i++)
1430     {
1431       error = vlib_buffer_pool_create(vm, dm->num_mbufs, MBUF_SIZE,
1432                                       rte_lcore_to_socket_id(i));
1433       if (error)
1434         return error;
1435     }
1436
1437   if (dm->use_rss)
1438     {
1439       vlib_node_runtime_t * rt = vlib_node_get_runtime (vm, dpdk_input_node.index);
1440       rt->function = dpdk_input_rss;
1441     }
1442  done:
1443   return error;
1444 }
1445
1446 VLIB_CONFIG_FUNCTION (dpdk_config, "dpdk");
1447
1448 void dpdk_update_link_state (dpdk_device_t * xd, f64 now)
1449 {
1450     vnet_main_t * vnm = vnet_get_main();
1451     struct rte_eth_link prev_link = xd->link;
1452     u32 hw_flags =  0;
1453     u8 hw_flags_chg = 0;
1454
1455     /* only update link state for PMD interfaces */
1456     if (xd->dev_type != VNET_DPDK_DEV_ETH)
1457       return;
1458
1459     xd->time_last_link_update = now ? now : xd->time_last_link_update;
1460     memset(&xd->link, 0, sizeof(xd->link));
1461     rte_eth_link_get_nowait (xd->device_index, &xd->link);
1462
1463     if (LINK_STATE_ELOGS)
1464       {
1465         vlib_main_t * vm = vlib_get_main();
1466         ELOG_TYPE_DECLARE(e) = {
1467           .format = 
1468           "update-link-state: sw_if_index %d, admin_up %d,"
1469           "old link_state %d new link_state %d",
1470           .format_args = "i4i1i1i1",
1471         };
1472
1473         struct { u32 sw_if_index; u8 admin_up; 
1474           u8 old_link_state; u8 new_link_state;} *ed;
1475         ed = ELOG_DATA (&vm->elog_main, e);
1476         ed->sw_if_index = xd->vlib_sw_if_index;
1477         ed->admin_up = xd->admin_up;
1478         ed->old_link_state = (u8)
1479           vnet_hw_interface_is_link_up (vnm, xd->vlib_hw_if_index);
1480         ed->new_link_state = (u8) xd->link.link_status;
1481       }
1482
1483     if ((xd->admin_up == 1) && 
1484         ((xd->link.link_status != 0) ^ 
1485          vnet_hw_interface_is_link_up (vnm, xd->vlib_hw_if_index)))
1486       {
1487         hw_flags_chg = 1;
1488         hw_flags |= (xd->link.link_status ? 
1489                      VNET_HW_INTERFACE_FLAG_LINK_UP: 0);
1490       }
1491
1492     if (hw_flags_chg || (xd->link.link_duplex != prev_link.link_duplex))
1493       {
1494         hw_flags_chg = 1;
1495         switch (xd->link.link_duplex)
1496           {
1497           case ETH_LINK_HALF_DUPLEX:
1498             hw_flags |= VNET_HW_INTERFACE_FLAG_HALF_DUPLEX;
1499             break;
1500           case ETH_LINK_FULL_DUPLEX:
1501             hw_flags |= VNET_HW_INTERFACE_FLAG_FULL_DUPLEX;
1502             break;
1503           default:
1504             break;
1505           }
1506       }
1507     if (hw_flags_chg || (xd->link.link_speed != prev_link.link_speed))
1508       {
1509         hw_flags_chg = 1;
1510         switch (xd->link.link_speed)
1511           {
1512           case ETH_LINK_SPEED_10:
1513             hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_10M;
1514             break;
1515           case ETH_LINK_SPEED_100:
1516             hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_100M;
1517             break;
1518           case ETH_LINK_SPEED_1000:
1519             hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_1G;
1520             break;
1521           case ETH_LINK_SPEED_10000:
1522             hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_10G;
1523             break;
1524           case ETH_LINK_SPEED_40G:
1525             hw_flags |= VNET_HW_INTERFACE_FLAG_SPEED_40G;
1526             break;
1527     case 0:
1528       break;
1529     default:
1530       clib_warning("unknown link speed %d", xd->link.link_speed);
1531             break;
1532           }
1533       }
1534     if (hw_flags_chg)
1535       {
1536         if (LINK_STATE_ELOGS)
1537           {
1538             vlib_main_t * vm = vlib_get_main();
1539
1540             ELOG_TYPE_DECLARE(e) = {
1541               .format = "update-link-state: sw_if_index %d, new flags %d",
1542               .format_args = "i4i4",
1543             };
1544
1545             struct { u32 sw_if_index; u32 flags; } *ed;
1546             ed = ELOG_DATA (&vm->elog_main, e);
1547             ed->sw_if_index = xd->vlib_sw_if_index;
1548             ed->flags = hw_flags;
1549           }
1550         vnet_hw_interface_set_flags (vnm, xd->vlib_hw_if_index, hw_flags);
1551       }
1552 }
1553
1554 static uword
1555 dpdk_process (vlib_main_t * vm,
1556               vlib_node_runtime_t * rt,
1557               vlib_frame_t * f)
1558 {
1559   clib_error_t * error;
1560   vnet_main_t * vnm = vnet_get_main();
1561   dpdk_main_t * dm = &dpdk_main;
1562   ethernet_main_t * em = &ethernet_main;
1563   dpdk_device_t * xd;
1564   vlib_thread_main_t * tm = vlib_get_thread_main();
1565   void *vu_state;
1566   int i;
1567
1568   error = dpdk_lib_init (dm);
1569
1570   /* 
1571    * Turn on the input node if we found some devices to drive
1572    * and we're not running worker threads or i/o threads
1573    */
1574
1575   if (error == 0 && vec_len(dm->devices) > 0)
1576     {
1577         if (tm->n_vlib_mains == 1)
1578           vlib_node_set_state (vm, dpdk_input_node.index,
1579                                VLIB_NODE_STATE_POLLING);
1580         else if (tm->main_thread_is_io_node)
1581           vlib_node_set_state (vm, dpdk_io_input_node.index,
1582                                VLIB_NODE_STATE_POLLING);
1583         else if (!dm->have_io_threads)
1584           for (i=0; i < tm->n_vlib_mains; i++)
1585             if (vec_len(dm->devices_by_cpu[i]) > 0)
1586               vlib_node_set_state (vlib_mains[i], dpdk_input_node.index,
1587                                    VLIB_NODE_STATE_POLLING);
1588     }
1589
1590   if (error)
1591     clib_error_report (error);
1592
1593   dpdk_vhost_user_process_init(&vu_state);
1594
1595   dm->io_thread_release = 1;
1596
1597   f64 now = vlib_time_now (vm);
1598   vec_foreach (xd, dm->devices)
1599     {
1600       dpdk_update_link_state (xd, now);
1601     }
1602
1603 { // Setup MACs for bond interfaces and their links which was initialized in
1604   // dpdk_port_setup() but needs to be done again here to take effect.
1605   int nports = rte_eth_dev_count();
1606   if (nports > 0) {
1607       for (i = 0; i < nports; i++) {
1608           struct rte_eth_dev_info dev_info;
1609           rte_eth_dev_info_get(i, &dev_info);
1610           if (!dev_info.driver_name)
1611               dev_info.driver_name = dev_info.pci_dev->driver->name;
1612           ASSERT(dev_info.driver_name);
1613           if (strncmp(dev_info.driver_name, "rte_bond_pmd", 12) == 0) {
1614               u8  addr[6]; 
1615               u8  slink[16];
1616               int nlink = rte_eth_bond_slaves_get(i, slink, 16);
1617               if (nlink > 0) {
1618                   vnet_hw_interface_t * hi;
1619                   ethernet_interface_t * ei;
1620                   /* Get MAC of 1st slave link */
1621                   rte_eth_macaddr_get(slink[0], (struct ether_addr *)addr);
1622                   /* Set MAC of bounded interface to that of 1st slave link */
1623                   rte_eth_bond_mac_address_set(i, (struct ether_addr *)addr);
1624                   /* Populate MAC of bonded interface in VPP hw tables */
1625                   hi = vnet_get_hw_interface (
1626                       vnm, dm->devices[i].vlib_hw_if_index);
1627                   ei = pool_elt_at_index (em->interfaces, hi->hw_instance);
1628                   memcpy (hi->hw_address, addr, 6);
1629                   memcpy (ei->address, addr, 6);
1630                   /* Add MAC to other slave links */
1631                   while (nlink > 1) {
1632                       nlink--;
1633                       rte_eth_dev_mac_addr_add(
1634                           slink[nlink], (struct ether_addr *)addr, 0);
1635                   }
1636               }
1637           }
1638       }
1639   }
1640 }
1641
1642   while (1)
1643     {
1644       /*
1645        * check each time through the loop in case intervals are changed
1646        */
1647       f64 min_wait = dm->link_state_poll_interval < dm->stat_poll_interval ?
1648                      dm->link_state_poll_interval : dm->stat_poll_interval;
1649
1650       vlib_process_wait_for_event_or_clock (vm, min_wait);
1651
1652       if (dpdk_get_admin_up_down_in_progress())
1653           /* skip the poll if an admin up down is in progress (on any interface) */
1654           continue;
1655
1656       vec_foreach (xd, dm->devices)
1657         {
1658           f64 now = vlib_time_now (vm);
1659           if ((now - xd->time_last_stats_update) >= dm->stat_poll_interval)
1660             dpdk_update_counters (xd, now);
1661           if ((now - xd->time_last_link_update) >= dm->link_state_poll_interval)
1662             dpdk_update_link_state (xd, now);
1663
1664       if (xd->dev_type == VNET_DPDK_DEV_VHOST_USER)
1665           if (dpdk_vhost_user_process_if(vm, xd, vu_state) != 0)
1666               continue;
1667         }
1668     }
1669
1670   dpdk_vhost_user_process_cleanup(vu_state);
1671
1672   return 0; 
1673 }
1674
1675 VLIB_REGISTER_NODE (dpdk_process_node,static) = {
1676     .function = dpdk_process,
1677     .type = VLIB_NODE_TYPE_PROCESS,
1678     .name = "dpdk-process",
1679     .process_log2_n_stack_bytes = 17,
1680 };
1681
1682 int dpdk_set_stat_poll_interval (f64 interval)
1683 {
1684   if (interval < DPDK_MIN_STATS_POLL_INTERVAL)
1685       return (VNET_API_ERROR_INVALID_VALUE);
1686
1687   dpdk_main.stat_poll_interval = interval;
1688
1689   return 0;
1690 }
1691
1692 int dpdk_set_link_state_poll_interval (f64 interval)
1693 {
1694   if (interval < DPDK_MIN_LINK_POLL_INTERVAL)
1695       return (VNET_API_ERROR_INVALID_VALUE);
1696
1697   dpdk_main.link_state_poll_interval = interval;
1698
1699   return 0;
1700 }
1701
1702 clib_error_t *
1703 dpdk_init (vlib_main_t * vm)
1704 {
1705   dpdk_main_t * dm = &dpdk_main;
1706   vlib_node_t * ei;
1707   clib_error_t * error = 0;
1708   vlib_thread_main_t * tm = vlib_get_thread_main();
1709
1710   /* verify that structs are cacheline aligned */
1711   ASSERT(offsetof(dpdk_device_t, cacheline0) == 0);
1712   ASSERT(offsetof(dpdk_device_t, cacheline1) == CLIB_CACHE_LINE_BYTES);
1713   ASSERT(offsetof(dpdk_worker_t, cacheline0) == 0);
1714   ASSERT(offsetof(frame_queue_trace_t, cacheline0) == 0);
1715
1716   /* Add references to DPDK Driver Constructor functions to get the dynamic
1717    * loader to pull in the driver library & run the constructors.
1718    */
1719 #define _(d)                                          \
1720 do {                                                  \
1721   void devinitfn_ ##d(void);                          \
1722   __attribute__((unused)) void (* volatile pf)(void); \
1723   pf = devinitfn_ ##d;                                \
1724 } while(0);
1725
1726 #ifdef RTE_LIBRTE_EM_PMD
1727   _(em_pmd_drv)
1728 #endif
1729
1730 #ifdef RTE_LIBRTE_IGB_PMD
1731   _(pmd_igb_drv)
1732 #endif
1733
1734 #ifdef RTE_LIBRTE_IXGBE_PMD
1735   _(rte_ixgbe_driver)
1736 #endif
1737
1738 #ifdef RTE_LIBRTE_I40E_PMD
1739   _(rte_i40e_driver)
1740   _(rte_i40evf_driver)
1741 #endif
1742
1743 #ifdef RTE_LIBRTE_FM10K_PMD
1744   _(rte_fm10k_driver)
1745 #endif
1746
1747 #ifdef RTE_LIBRTE_VIRTIO_PMD
1748   _(rte_virtio_driver)
1749 #endif
1750
1751 #ifdef RTE_LIBRTE_VMXNET3_PMD
1752   _(rte_vmxnet3_driver)
1753 #endif
1754
1755 #ifdef RTE_LIBRTE_VICE_PMD
1756   _(rte_vice_driver)
1757 #endif
1758
1759 #ifdef RTE_LIBRTE_ENIC_PMD
1760   _(rte_enic_driver)
1761 #endif
1762
1763 #ifdef RTE_LIBRTE_PMD_AF_PACKET
1764   _(pmd_af_packet_drv)
1765 #endif
1766
1767 #ifdef RTE_LIBRTE_CXGBE_PMD
1768   _(rte_cxgbe_driver)
1769 #endif
1770
1771 #ifdef RTE_LIBRTE_PMD_BOND
1772   _(bond_drv)
1773 #endif
1774
1775 #undef _
1776
1777 /* 
1778  * At the moment, the ThunderX NIC driver doesn't have
1779  * an entry point named "devinitfn_rte_xxx_driver"
1780  */
1781 #define _(d)                                          \
1782 do {                                                  \
1783   void d(void);                                       \
1784   __attribute__((unused)) void (* volatile pf)(void); \
1785   pf = d;                                             \
1786 } while(0);
1787
1788 #ifdef RTE_LIBRTE_THUNDERVNIC_PMD
1789 _(rte_nicvf_pmd_init)
1790 #endif
1791 #undef _
1792
1793   dm->vlib_main = vm;
1794   dm->vnet_main = vnet_get_main();
1795
1796   ei = vlib_get_node_by_name (vm, (u8 *) "ethernet-input");
1797   if (ei == 0)
1798       return clib_error_return (0, "ethernet-input node AWOL");
1799
1800   dm->ethernet_input_node_index = ei->index;
1801
1802   dm->nchannels = 4;
1803   dm->num_mbufs = dm->num_mbufs ? dm->num_mbufs : NB_MBUF;
1804   vec_add1 (dm->eal_init_args, (u8 *) "vnet");
1805
1806   dm->dpdk_device_by_kni_port_id = hash_create (0, sizeof (uword));
1807   dm->vu_sw_if_index_by_listener_fd = hash_create (0, sizeof (uword));
1808   dm->vu_sw_if_index_by_sock_fd = hash_create (0, sizeof (uword));
1809
1810   /* $$$ use n_thread_stacks since it's known-good at this point */
1811   vec_validate (dm->recycle, tm->n_thread_stacks - 1);
1812
1813   /* initialize EFD (early fast discard) default settings */
1814   dm->efd.enabled = DPDK_EFD_DISABLED;
1815   dm->efd.queue_hi_thresh = ((DPDK_EFD_DEFAULT_DEVICE_QUEUE_HI_THRESH_PCT *
1816                               DPDK_NB_RX_DESC_10GE)/100);
1817   dm->efd.consec_full_frames_hi_thresh =
1818       DPDK_EFD_DEFAULT_CONSEC_FULL_FRAMES_HI_THRESH;
1819
1820   /* vhost-user coalescence frames defaults */
1821   dm->vhost_coalesce_frames = 32;
1822   dm->vhost_coalesce_time = 1e-3;
1823
1824   /* Default vlib_buffer_t flags, DISABLES tcp/udp checksumming... */
1825   dm->buffer_flags_template = 
1826     (VLIB_BUFFER_TOTAL_LENGTH_VALID 
1827      | IP_BUFFER_L4_CHECKSUM_COMPUTED
1828      | IP_BUFFER_L4_CHECKSUM_CORRECT);
1829
1830   dm->stat_poll_interval = DPDK_STATS_POLL_INTERVAL;
1831   dm->link_state_poll_interval = DPDK_LINK_POLL_INTERVAL;
1832
1833   /* init CLI */
1834   if ((error = vlib_call_init_function (vm, dpdk_cli_init)))
1835     return error;
1836
1837   return error;
1838 }
1839
1840 VLIB_INIT_FUNCTION (dpdk_init);
1841