Enable Chelsio T5 support
[vpp.git] / vnet / vnet / devices / dpdk / device.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/format.h>
18 #include <vlib/unix/cj.h>
19
20 #include <vnet/ethernet/ethernet.h>
21 #include <vnet/devices/dpdk/dpdk.h>
22
23 #include "dpdk_priv.h"
24 #include <vppinfra/error.h>
25
26 #define foreach_dpdk_tx_func_error                      \
27   _(BAD_RETVAL, "DPDK tx function returned an error")   \
28   _(RING_FULL, "Tx packet drops (ring full)")           \
29   _(PKT_DROP, "Tx packet drops (dpdk tx failure)")      \
30   _(REPL_FAIL, "Tx packet drops (replication failure)")
31
32 typedef enum {
33 #define _(f,s) DPDK_TX_FUNC_ERROR_##f,
34   foreach_dpdk_tx_func_error
35 #undef _
36   DPDK_TX_FUNC_N_ERROR,
37 } dpdk_tx_func_error_t;
38
39 static char * dpdk_tx_func_error_strings[] = {
40 #define _(n,s) s,
41     foreach_dpdk_tx_func_error
42 #undef _
43 };
44
45 static struct rte_mbuf * dpdk_replicate_packet_mb (vlib_buffer_t * b)
46 {
47   vlib_main_t * vm = vlib_get_main();
48   vlib_buffer_main_t * bm = vm->buffer_main;
49   struct rte_mbuf * first_mb = 0, * new_mb, * pkt_mb, ** prev_mb_next = 0;
50   u8 nb_segs, nb_segs_left;
51   u32 copy_bytes;
52   unsigned socket_id = rte_socket_id();
53
54   ASSERT (bm->pktmbuf_pools[socket_id]);
55   pkt_mb = ((struct rte_mbuf *)b)-1;
56   nb_segs = pkt_mb->nb_segs;
57   for (nb_segs_left = nb_segs; nb_segs_left; nb_segs_left--)
58     {
59       if (PREDICT_FALSE(pkt_mb == 0))
60         {
61           clib_warning ("Missing %d mbuf chain segment(s):   "
62                         "(nb_segs = %d, nb_segs_left = %d)!",
63                         nb_segs - nb_segs_left, nb_segs, nb_segs_left);
64           if (first_mb)
65             rte_pktmbuf_free(first_mb);
66           return NULL;
67         }
68       new_mb = rte_pktmbuf_alloc (bm->pktmbuf_pools[socket_id]);
69       if (PREDICT_FALSE(new_mb == 0))
70         {
71           if (first_mb)
72             rte_pktmbuf_free(first_mb);
73           return NULL;
74         }
75       
76       /*
77        * Copy packet info into 1st segment.
78        */
79       if (first_mb == 0)
80         {
81           first_mb = new_mb;
82           rte_pktmbuf_pkt_len (first_mb) = pkt_mb->pkt_len;
83           first_mb->nb_segs = pkt_mb->nb_segs;
84           first_mb->port = pkt_mb->port;
85 #ifdef DAW_FIXME // TX Offload support TBD
86           first_mb->vlan_macip = pkt_mb->vlan_macip;
87           first_mb->hash = pkt_mb->hash;
88           first_mb->ol_flags = pkt_mb->ol_flags
89 #endif
90         }
91       else
92         {
93           ASSERT(prev_mb_next != 0);
94           *prev_mb_next = new_mb;
95         }
96       
97       /*
98        * Copy packet segment data into new mbuf segment.
99        */
100       rte_pktmbuf_data_len (new_mb) = pkt_mb->data_len;
101       copy_bytes = pkt_mb->data_len + RTE_PKTMBUF_HEADROOM;
102       ASSERT(copy_bytes <= pkt_mb->buf_len);
103       memcpy(new_mb->buf_addr, pkt_mb->buf_addr, copy_bytes);
104
105       prev_mb_next = &new_mb->next;
106       pkt_mb = pkt_mb->next;
107     }
108
109   ASSERT(pkt_mb == 0);
110   __rte_mbuf_sanity_check(first_mb, 1);
111
112   return first_mb;
113 }
114
115 typedef struct {
116   u32 buffer_index;
117   u16 device_index;
118   u8 queue_index;
119   struct rte_mbuf mb;
120   /* Copy of VLIB buffer; packet data stored in pre_data. */
121   vlib_buffer_t buffer;
122 } dpdk_tx_dma_trace_t;
123
124 static void
125 dpdk_tx_trace_buffer (dpdk_main_t * dm,
126                       vlib_node_runtime_t * node,
127                       dpdk_device_t * xd,
128                       u16 queue_id,
129                       u32 buffer_index,
130                       vlib_buffer_t * buffer)
131 {
132   vlib_main_t * vm = vlib_get_main();
133   dpdk_tx_dma_trace_t * t0;
134   struct rte_mbuf * mb;
135
136   mb = ((struct rte_mbuf *)buffer)-1;
137
138   t0 = vlib_add_trace (vm, node, buffer, sizeof (t0[0]));
139   t0->queue_index = queue_id;
140   t0->device_index = xd->device_index;
141   t0->buffer_index = buffer_index;
142   memcpy (&t0->mb, mb, sizeof (t0->mb));
143   memcpy (&t0->buffer, buffer, sizeof (buffer[0]) - sizeof (buffer->pre_data));
144   memcpy (t0->buffer.pre_data, buffer->data + buffer->current_data,
145           sizeof (t0->buffer.pre_data));
146 }
147
148 /*
149  * This function calls the dpdk's tx_burst function to transmit the packets
150  * on the tx_vector. It manages a lock per-device if the device does not
151  * support multiple queues. It returns the number of packets untransmitted 
152  * on the tx_vector. If all packets are transmitted (the normal case), the 
153  * function returns 0.
154  * 
155  * The tx_burst function may not be able to transmit all packets because the 
156  * dpdk ring is full. If a flowcontrol callback function has been configured
157  * then the function simply returns. If no callback has been configured, the 
158  * function will retry calling tx_burst with the remaining packets. This will 
159  * continue until all packets are transmitted or tx_burst indicates no packets
160  * could be transmitted. (The caller can drop the remaining packets.)
161  *
162  * The function assumes there is at least one packet on the tx_vector.
163  */
164 static_always_inline
165 u32 tx_burst_vector_internal (vlib_main_t * vm, 
166                               dpdk_device_t * xd,
167                               struct rte_mbuf ** tx_vector)
168 {
169   dpdk_main_t * dm = &dpdk_main;
170   u32 n_packets;
171   u32 tx_head;
172   u32 tx_tail;
173   u32 n_retry;
174   int rv;
175   int queue_id;
176   tx_ring_hdr_t *ring;
177
178   ring = vec_header(tx_vector, sizeof(*ring));
179
180   n_packets = ring->tx_head - ring->tx_tail;
181
182   tx_head = ring->tx_head % DPDK_TX_RING_SIZE;
183
184   /*
185    * Ensure rte_eth_tx_burst is not called with 0 packets, which can lead to
186    * unpredictable results.
187    */
188   ASSERT(n_packets > 0);
189
190   /*
191    * Check for tx_vector overflow. If this fails it is a system configuration
192    * error. The ring should be sized big enough to handle the largest un-flowed
193    * off burst from a traffic manager. A larger size also helps performance
194    * a bit because it decreases the probability of having to issue two tx_burst
195    * calls due to a ring wrap.
196    */
197   ASSERT(n_packets < DPDK_TX_RING_SIZE);
198
199   /*
200    * If there is no flowcontrol callback, there is only temporary buffering
201    * on the tx_vector and so the tail should always be 0.
202    */
203   ASSERT(dm->flowcontrol_callback || ring->tx_tail == 0);
204
205   /*
206    * If there is a flowcontrol callback, don't retry any incomplete tx_bursts. 
207    * Apply backpressure instead. If there is no callback, keep retrying until
208    * a tx_burst sends no packets. n_retry of 255 essentially means no retry 
209    * limit.
210    */
211   n_retry = dm->flowcontrol_callback ? 0 : 255;
212
213   queue_id = vm->cpu_index;
214
215   do {
216       /* start the burst at the tail */
217       tx_tail = ring->tx_tail % DPDK_TX_RING_SIZE;
218
219       /* 
220        * This device only supports one TX queue,
221        * and we're running multi-threaded...
222        */
223       if (PREDICT_FALSE(xd->lockp != 0))
224         {
225           queue_id = 0;
226           while (__sync_lock_test_and_set (xd->lockp, 1))
227             /* zzzz */;
228         }
229
230       if (PREDICT_TRUE(xd->dev_type == VNET_DPDK_DEV_ETH)) 
231         {
232           if (PREDICT_TRUE(tx_head > tx_tail)) 
233             {
234               /* no wrap, transmit in one burst */
235               rv = rte_eth_tx_burst(xd->device_index, 
236                                     (uint16_t) queue_id,
237                                     &tx_vector[tx_tail], 
238                                     (uint16_t) (tx_head-tx_tail));
239             }
240           else 
241             {
242               /* 
243                * This can only happen if there is a flowcontrol callback.
244                * We need to split the transmit into two calls: one for
245                * the packets up to the wrap point, and one to continue
246                * at the start of the ring.
247                * Transmit pkts up to the wrap point.
248                */
249               rv = rte_eth_tx_burst(xd->device_index, 
250                                     (uint16_t) queue_id,
251                                     &tx_vector[tx_tail], 
252                                     (uint16_t) (DPDK_TX_RING_SIZE - tx_tail));
253
254               /* 
255                * If we transmitted everything we wanted, then allow 1 retry 
256                * so we can try to transmit the rest. If we didn't transmit
257                * everything, stop now.
258                */
259               n_retry = (rv == DPDK_TX_RING_SIZE - tx_tail) ? 1 : 0;
260             }
261         } 
262       else if (xd->dev_type == VNET_DPDK_DEV_VHOST_USER)
263         {
264           if (PREDICT_TRUE(tx_head > tx_tail)) 
265             {
266               /* no wrap, transmit in one burst */
267               rv = rte_vhost_enqueue_burst(&xd->vu_vhost_dev, VIRTIO_RXQ,
268                                            &tx_vector[tx_tail],
269                                            (uint16_t) (tx_head-tx_tail));
270               if (PREDICT_TRUE(rv > 0))
271                 {
272                   if (dpdk_vhost_user_want_interrupt(xd, VIRTIO_RXQ)) {
273                     dpdk_vu_vring *vring = &(xd->vu_intf->vrings[VIRTIO_RXQ]);
274                     vring->n_since_last_int += rv;
275
276                     if (vring->n_since_last_int > dm->vhost_coalesce_frames)
277                       dpdk_vhost_user_send_interrupt(dm->vlib_main, xd, VIRTIO_RXQ);
278                   }
279
280                   int c = rv;
281                   while(c--)
282                     rte_pktmbuf_free (tx_vector[tx_tail+c]);
283                 }
284             }
285           else
286             {
287               /*
288                * If we transmitted everything we wanted, then allow 1 retry
289                * so we can try to transmit the rest. If we didn't transmit
290                * everything, stop now.
291                */
292               rv = rte_vhost_enqueue_burst(&xd->vu_vhost_dev, VIRTIO_RXQ,
293                                            &tx_vector[tx_tail], 
294                                            (uint16_t) (DPDK_TX_RING_SIZE - tx_tail));
295
296               if (PREDICT_TRUE(rv > 0))
297                 {
298                   if (dpdk_vhost_user_want_interrupt(xd, VIRTIO_RXQ)) {
299                     dpdk_vu_vring *vring = &(xd->vu_intf->vrings[VIRTIO_RXQ]);
300                     vring->n_since_last_int += rv;
301
302                     if (vring->n_since_last_int > dm->vhost_coalesce_frames)
303                       dpdk_vhost_user_send_interrupt(dm->vlib_main, xd, VIRTIO_RXQ);
304                   }
305
306                   int c = rv;
307                   while(c--)
308                     rte_pktmbuf_free (tx_vector[tx_tail+c]);
309                 }
310
311               n_retry = (rv == DPDK_TX_RING_SIZE - tx_tail) ? 1 : 0;
312             }
313         }
314       else if (xd->dev_type == VNET_DPDK_DEV_KNI)
315         {
316           if (PREDICT_TRUE(tx_head > tx_tail)) 
317             {
318               /* no wrap, transmit in one burst */
319               rv = rte_kni_tx_burst(xd->kni, 
320                                     &tx_vector[tx_tail], 
321                                     (uint16_t) (tx_head-tx_tail));
322             }
323           else 
324             {
325               /* 
326                * This can only happen if there is a flowcontrol callback.
327                * We need to split the transmit into two calls: one for
328                * the packets up to the wrap point, and one to continue
329                * at the start of the ring.
330                * Transmit pkts up to the wrap point.
331                */
332               rv = rte_kni_tx_burst(xd->kni, 
333                                     &tx_vector[tx_tail], 
334                                     (uint16_t) (DPDK_TX_RING_SIZE - tx_tail));
335
336               /* 
337                * If we transmitted everything we wanted, then allow 1 retry 
338                * so we can try to transmit the rest. If we didn't transmit
339                * everything, stop now.
340                */
341               n_retry = (rv == DPDK_TX_RING_SIZE - tx_tail) ? 1 : 0;
342             }
343         } 
344       else
345         {
346           ASSERT(0);
347           rv = 0;
348         }
349
350       if (PREDICT_FALSE(xd->lockp != 0))
351           *xd->lockp = 0;
352
353       if (PREDICT_FALSE(rv < 0))
354         {
355           // emit non-fatal message, bump counter
356           vnet_main_t * vnm = dm->vnet_main;
357           vnet_interface_main_t * im = &vnm->interface_main;
358           u32 node_index;
359
360           node_index = vec_elt_at_index(im->hw_interfaces, 
361                                         xd->vlib_hw_if_index)->tx_node_index;
362
363           vlib_error_count (vm, node_index, DPDK_TX_FUNC_ERROR_BAD_RETVAL, 1);
364           clib_warning ("rte_eth_tx_burst[%d]: error %d", xd->device_index, rv);
365           return n_packets; // untransmitted packets
366         }
367       ring->tx_tail += (u16)rv;
368       n_packets -= (uint16_t) rv;
369   } while (rv && n_packets && (n_retry>0));
370
371   return n_packets;
372 }
373
374
375 /*
376  * This function transmits any packets on the interface's tx_vector and returns
377  * the number of packets untransmitted on the tx_vector. If the tx_vector is 
378  * empty the function simply returns 0. 
379  *
380  * It is intended to be called by a traffic manager which has flowed-off an
381  * interface to see if the interface can be flowed-on again.
382  */
383 u32 dpdk_interface_tx_vector (vlib_main_t * vm, u32 dev_instance)
384 {
385   dpdk_main_t * dm = &dpdk_main;
386   dpdk_device_t * xd;
387   int queue_id;
388   struct rte_mbuf ** tx_vector;
389   tx_ring_hdr_t *ring;
390  
391   /* param is dev_instance and not hw_if_index to save another lookup */
392   xd = vec_elt_at_index (dm->devices, dev_instance);
393
394   queue_id = vm->cpu_index;
395   tx_vector = xd->tx_vectors[queue_id];
396
397   /* If no packets on the ring, don't bother calling tx function */
398   ring = vec_header(tx_vector, sizeof(*ring));
399   if (ring->tx_head == ring->tx_tail) 
400     {
401       return 0;
402     }
403
404   return tx_burst_vector_internal (vm, xd, tx_vector);
405 }
406
407 /*
408  * Transmits the packets on the frame to the interface associated with the
409  * node. It first copies packets on the frame to a tx_vector containing the 
410  * rte_mbuf pointers. It then passes this vector to tx_burst_vector_internal 
411  * which calls the dpdk tx_burst function.
412  *
413  * The tx_vector is treated slightly differently depending on whether or
414  * not a flowcontrol callback function has been configured. If there is no
415  * callback, the tx_vector is a temporary array of rte_mbuf packet pointers.
416  * Its entries are written and consumed before the function exits. 
417  *
418  * If there is a callback then the transmit is being invoked in the presence
419  * of a traffic manager. Here the tx_vector is treated like a ring of rte_mbuf
420  * pointers. If not all packets can be transmitted, the untransmitted packets
421  * stay on the tx_vector until the next call. The callback allows the traffic
422  * manager to flow-off dequeues to the interface. The companion function
423  * dpdk_interface_tx_vector() allows the traffic manager to detect when
424  * it should flow-on the interface again.
425  */
426 static uword
427 dpdk_interface_tx (vlib_main_t * vm,
428            vlib_node_runtime_t * node,
429            vlib_frame_t * f)
430 {
431   dpdk_main_t * dm = &dpdk_main;
432   vnet_interface_output_runtime_t * rd = (void *) node->runtime_data;
433   dpdk_device_t * xd = vec_elt_at_index (dm->devices, rd->dev_instance);
434   u32 n_packets = f->n_vectors;
435   u32 n_left;
436   u32 * from;
437   struct rte_mbuf ** tx_vector;
438   int i;
439   int queue_id;
440   u32 my_cpu;
441   u32 tx_pkts = 0;
442   tx_ring_hdr_t *ring;
443   u32 n_on_ring;
444
445   my_cpu = vm->cpu_index;
446
447   queue_id = my_cpu;
448
449   tx_vector = xd->tx_vectors[queue_id];
450   ring = vec_header(tx_vector, sizeof(*ring));
451
452   n_on_ring = ring->tx_head - ring->tx_tail;
453   from = vlib_frame_vector_args (f);
454
455   ASSERT(n_packets <= VLIB_FRAME_SIZE);
456
457   if (PREDICT_FALSE(n_on_ring + n_packets > DPDK_TX_RING_SIZE))
458     {
459       /*
460        * Overflowing the ring should never happen. 
461        * If it does then drop the whole frame.
462        */
463       vlib_error_count (vm, node->node_index, DPDK_TX_FUNC_ERROR_RING_FULL,
464                         n_packets);
465
466       while (n_packets--) 
467         {
468           u32 bi0 = from[n_packets];
469           vlib_buffer_t *b0 = vlib_get_buffer (vm, bi0);
470           struct rte_mbuf *mb0 = ((struct rte_mbuf *)b0) - 1;
471           rte_pktmbuf_free (mb0);
472         }
473       return n_on_ring;
474     }
475
476   if (PREDICT_FALSE(dm->tx_pcap_enable))
477     {
478       n_left = n_packets;
479       while (n_left > 0)
480         {
481           u32 bi0 = from[0];
482           vlib_buffer_t * b0 = vlib_get_buffer (vm, bi0);
483           if (dm->pcap_sw_if_index == 0 ||
484               dm->pcap_sw_if_index == vnet_buffer(b0)->sw_if_index [VLIB_TX])
485               pcap_add_buffer (&dm->pcap_main, vm, bi0, 512);
486           from++;
487           n_left--;
488         }
489     }
490
491   from = vlib_frame_vector_args (f);
492   n_left = n_packets;
493   i = ring->tx_head % DPDK_TX_RING_SIZE;
494
495   while (n_left >= 4)
496     {
497       u32 bi0, bi1;
498       u32 pi0, pi1;
499       struct rte_mbuf * mb0, * mb1;
500       struct rte_mbuf * prefmb0, * prefmb1;
501       vlib_buffer_t * b0, * b1;
502       vlib_buffer_t * pref0, * pref1;
503       i16 delta0, delta1;
504       u16 new_data_len0, new_data_len1;
505       u16 new_pkt_len0, new_pkt_len1;
506       u32 any_clone;
507
508       pi0 = from[2];
509       pi1 = from[3];
510       pref0 = vlib_get_buffer (vm, pi0);
511       pref1 = vlib_get_buffer (vm, pi1);
512
513       prefmb0 = ((struct rte_mbuf *)pref0) - 1;
514       prefmb1 = ((struct rte_mbuf *)pref1) - 1;
515       
516       CLIB_PREFETCH(prefmb0, CLIB_CACHE_LINE_BYTES, LOAD);
517       CLIB_PREFETCH(pref0, CLIB_CACHE_LINE_BYTES, LOAD);
518       CLIB_PREFETCH(prefmb1, CLIB_CACHE_LINE_BYTES, LOAD);
519       CLIB_PREFETCH(pref1, CLIB_CACHE_LINE_BYTES, LOAD);
520
521       bi0 = from[0];
522       bi1 = from[1];
523       from += 2;
524       
525       b0 = vlib_get_buffer (vm, bi0);
526       b1 = vlib_get_buffer (vm, bi1);
527
528       mb0 = ((struct rte_mbuf *)b0) - 1;
529       mb1 = ((struct rte_mbuf *)b1) - 1;
530
531       any_clone = b0->clone_count | b1->clone_count;
532       if (PREDICT_FALSE(any_clone != 0))
533         {
534           if (PREDICT_FALSE(b0->clone_count != 0))
535         {
536           struct rte_mbuf * mb0_new = dpdk_replicate_packet_mb (b0);
537           if (PREDICT_FALSE(mb0_new == 0))
538             {
539               vlib_error_count (vm, node->node_index,
540                     DPDK_TX_FUNC_ERROR_REPL_FAIL, 1);
541               b0->flags |= VLIB_BUFFER_REPL_FAIL;
542             }
543           else
544             mb0 = mb0_new;
545           vec_add1 (dm->recycle[my_cpu], bi0);
546         }
547           if (PREDICT_FALSE(b1->clone_count != 0))
548         {
549           struct rte_mbuf * mb1_new = dpdk_replicate_packet_mb (b1);
550           if (PREDICT_FALSE(mb1_new == 0))
551             {
552               vlib_error_count (vm, node->node_index,
553                     DPDK_TX_FUNC_ERROR_REPL_FAIL, 1);
554               b1->flags |= VLIB_BUFFER_REPL_FAIL;
555             }
556           else
557             mb1 = mb1_new;
558           vec_add1 (dm->recycle[my_cpu], bi1);
559         }
560     }
561
562       delta0 = PREDICT_FALSE(b0->flags & VLIB_BUFFER_REPL_FAIL) ? 0 :
563     vlib_buffer_length_in_chain (vm, b0) - (i16) mb0->pkt_len;
564       delta1 = PREDICT_FALSE(b1->flags & VLIB_BUFFER_REPL_FAIL) ? 0 :
565     vlib_buffer_length_in_chain (vm, b1) - (i16) mb1->pkt_len;
566       
567       new_data_len0 = (u16)((i16) mb0->data_len + delta0);
568       new_data_len1 = (u16)((i16) mb1->data_len + delta1);
569       new_pkt_len0 = (u16)((i16) mb0->pkt_len + delta0);
570       new_pkt_len1 = (u16)((i16) mb1->pkt_len + delta1);
571
572       b0->current_length = new_data_len0;
573       b1->current_length = new_data_len1;
574       mb0->data_len = new_data_len0;
575       mb1->data_len = new_data_len1;
576       mb0->pkt_len = new_pkt_len0;
577       mb1->pkt_len = new_pkt_len1;
578
579       mb0->data_off = (PREDICT_FALSE(b0->flags & VLIB_BUFFER_REPL_FAIL)) ?
580           mb0->data_off : (u16)(RTE_PKTMBUF_HEADROOM + b0->current_data);
581       mb1->data_off = (PREDICT_FALSE(b1->flags & VLIB_BUFFER_REPL_FAIL)) ?
582           mb1->data_off : (u16)(RTE_PKTMBUF_HEADROOM + b1->current_data);
583
584       if (PREDICT_FALSE(node->flags & VLIB_NODE_FLAG_TRACE))
585     {
586           if (b0->flags & VLIB_BUFFER_IS_TRACED)
587               dpdk_tx_trace_buffer (dm, node, xd, queue_id, bi0, b0);
588           if (b1->flags & VLIB_BUFFER_IS_TRACED)
589               dpdk_tx_trace_buffer (dm, node, xd, queue_id, bi1, b1);
590     }
591
592       if (PREDICT_TRUE(any_clone == 0))
593         {
594       tx_vector[i % DPDK_TX_RING_SIZE] = mb0;
595           i++;
596       tx_vector[i % DPDK_TX_RING_SIZE] = mb1;
597           i++;
598         }
599       else
600         {
601           /* cloning was done, need to check for failure */
602           if (PREDICT_TRUE((b0->flags & VLIB_BUFFER_REPL_FAIL) == 0))
603             {
604           tx_vector[i % DPDK_TX_RING_SIZE] = mb0;
605               i++;
606             }
607           if (PREDICT_TRUE((b1->flags & VLIB_BUFFER_REPL_FAIL) == 0))
608             {
609           tx_vector[i % DPDK_TX_RING_SIZE] = mb1;
610               i++;
611             }
612         }
613
614       n_left -= 2;
615     }
616   while (n_left > 0)
617     {
618       u32 bi0;
619       struct rte_mbuf * mb0;
620       vlib_buffer_t * b0;
621       i16 delta0;
622       u16 new_data_len0;
623       u16 new_pkt_len0;
624
625       bi0 = from[0];
626       from++;
627       
628       b0 = vlib_get_buffer (vm, bi0);
629
630       mb0 = ((struct rte_mbuf *)b0) - 1;
631       if (PREDICT_FALSE(b0->clone_count != 0))
632     {
633       struct rte_mbuf * mb0_new = dpdk_replicate_packet_mb (b0);
634       if (PREDICT_FALSE(mb0_new == 0))
635         {
636           vlib_error_count (vm, node->node_index,
637                 DPDK_TX_FUNC_ERROR_REPL_FAIL, 1);
638           b0->flags |= VLIB_BUFFER_REPL_FAIL;
639         }
640       else
641         mb0 = mb0_new;
642       vec_add1 (dm->recycle[my_cpu], bi0);
643     }
644
645       delta0 = PREDICT_FALSE(b0->flags & VLIB_BUFFER_REPL_FAIL) ? 0 :
646     vlib_buffer_length_in_chain (vm, b0) - (i16) mb0->pkt_len;
647       
648       new_data_len0 = (u16)((i16) mb0->data_len + delta0);
649       new_pkt_len0 = (u16)((i16) mb0->pkt_len + delta0);
650       
651       b0->current_length = new_data_len0;
652       mb0->data_len = new_data_len0;
653       mb0->pkt_len = new_pkt_len0;
654       mb0->data_off = (PREDICT_FALSE(b0->flags & VLIB_BUFFER_REPL_FAIL)) ?
655           mb0->data_off : (u16)(RTE_PKTMBUF_HEADROOM + b0->current_data);
656
657       if (PREDICT_FALSE(node->flags & VLIB_NODE_FLAG_TRACE))
658           if (b0->flags & VLIB_BUFFER_IS_TRACED)
659               dpdk_tx_trace_buffer (dm, node, xd, queue_id, bi0, b0);
660
661       if (PREDICT_TRUE((b0->flags & VLIB_BUFFER_REPL_FAIL) == 0))
662         {
663       tx_vector[i % DPDK_TX_RING_SIZE] = mb0;
664           i++;
665         }
666       n_left--;
667     }
668
669   /* account for additional packets in the ring */
670   ring->tx_head += n_packets;
671   n_on_ring = ring->tx_head - ring->tx_tail;
672
673   /* transmit as many packets as possible */
674   n_packets = tx_burst_vector_internal (vm, xd, tx_vector);
675
676   /*
677    * tx_pkts is the number of packets successfully transmitted
678    * This is the number originally on ring minus the number remaining on ring
679    */
680   tx_pkts = n_on_ring - n_packets; 
681
682   if (PREDICT_FALSE(dm->flowcontrol_callback != 0))
683     {
684       if (PREDICT_FALSE(n_packets))
685         {
686           /* Callback may want to enable flowcontrol */
687           dm->flowcontrol_callback(vm, xd->vlib_hw_if_index, ring->tx_head - ring->tx_tail);
688         } 
689       else 
690         {
691           /* Reset head/tail to avoid unnecessary wrap */
692           ring->tx_head = 0;
693           ring->tx_tail = 0;
694         }
695     }
696   else 
697     {
698       /* If there is no callback then drop any non-transmitted packets */
699       if (PREDICT_FALSE(n_packets))
700         {
701           vlib_simple_counter_main_t * cm;
702           vnet_main_t * vnm = vnet_get_main();
703
704           cm = vec_elt_at_index (vnm->interface_main.sw_if_counters,
705                                  VNET_INTERFACE_COUNTER_TX_ERROR);
706
707           vlib_increment_simple_counter (cm, my_cpu, xd->vlib_sw_if_index, n_packets);
708
709           vlib_error_count (vm, node->node_index, DPDK_TX_FUNC_ERROR_PKT_DROP,
710                 n_packets);
711
712           while (n_packets--)
713             rte_pktmbuf_free (tx_vector[ring->tx_tail + n_packets]);
714         }
715
716         /* Reset head/tail to avoid unnecessary wrap */
717         ring->tx_head = 0;
718         ring->tx_tail = 0;
719     }
720
721   /* Recycle replicated buffers */
722   if (PREDICT_FALSE(vec_len(dm->recycle[my_cpu])))
723     {
724       vlib_buffer_free (vm, dm->recycle[my_cpu], vec_len(dm->recycle[my_cpu]));
725       _vec_len(dm->recycle[my_cpu]) = 0;
726     }
727
728   ASSERT(ring->tx_head >= ring->tx_tail);
729
730   return tx_pkts;
731 }
732
733 static int dpdk_device_renumber (vnet_hw_interface_t * hi,
734                                  u32 new_dev_instance)
735 {
736   dpdk_main_t * dm = &dpdk_main;
737   dpdk_device_t * xd = vec_elt_at_index (dm->devices, hi->dev_instance);
738
739   if (!xd || xd->dev_type != VNET_DPDK_DEV_VHOST_USER) {
740       clib_warning("cannot renumber non-vhost-user interface (sw_if_index: %d)",
741               hi->sw_if_index);
742       return 0;
743   }
744
745   xd->vu_if_id = new_dev_instance;
746   return 0;
747 }
748
749 static u8 * format_dpdk_device_name (u8 * s, va_list * args)
750 {
751   dpdk_main_t * dm = &dpdk_main;
752   char *devname_format;
753   char *device_name;
754   u32 i = va_arg (*args, u32);
755   struct rte_eth_dev_info dev_info;
756   u8 * ret;
757
758   if (dm->interface_name_format_decimal)
759     devname_format = "%s%d/%d/%d";
760   else
761     devname_format = "%s%x/%x/%x";
762
763   if (dm->devices[i].dev_type == VNET_DPDK_DEV_KNI) {
764        return format(s, "kni%d", dm->devices[i].kni_port_id);
765   } else if (dm->devices[i].dev_type == VNET_DPDK_DEV_VHOST_USER) {
766        return format(s, "VirtualEthernet0/0/%d", dm->devices[i].vu_if_id);
767   }
768   switch (dm->devices[i].port_type)
769     {
770     case VNET_DPDK_PORT_TYPE_ETH_1G:
771       device_name = "GigabitEthernet";
772       break;
773
774     case VNET_DPDK_PORT_TYPE_ETH_10G:
775       device_name = "TenGigabitEthernet";
776       break;
777
778     case VNET_DPDK_PORT_TYPE_ETH_40G:
779       device_name = "FortyGigabitEthernet";
780       break;
781
782     case VNET_DPDK_PORT_TYPE_ETH_SWITCH:
783       device_name = "EthernetSwitch";
784       break;
785
786   #ifdef NETMAP
787     case VNET_DPDK_PORT_TYPE_NETMAP:
788         rte_eth_dev_info_get(i, &dev_info);
789         return format(s, "netmap:%s", dev_info.driver_name);
790   #endif
791
792     case VNET_DPDK_PORT_TYPE_AF_PACKET:
793       rte_eth_dev_info_get(i, &dev_info);
794       return format(s, "af_packet%d", dm->devices[i].af_packet_port_id);
795
796     default:
797     case VNET_DPDK_PORT_TYPE_UNKNOWN:
798       device_name = "UnknownEthernet";
799       break;
800     }
801
802   rte_eth_dev_info_get(i, &dev_info);
803   ret = format (s, devname_format, device_name, dev_info.pci_dev->addr.bus,
804                  dev_info.pci_dev->addr.devid,
805                  dev_info.pci_dev->addr.function);
806
807   /* address Chelsio cards which share PCI address */
808         if (dm->devices[i].pmd ==  VNET_DPDK_PMD_CXGBE) {
809     struct rte_eth_dev_info di;
810
811     di.pci_dev = 0;
812     rte_eth_dev_info_get(i+1, &di);
813     if (di.pci_dev && memcmp(&dev_info.pci_dev->addr, &di.pci_dev->addr,
814         sizeof(struct rte_pci_addr)) == 0)
815             return format(ret, "/0");   
816
817     di.pci_dev = 0;
818     rte_eth_dev_info_get(i-1, &di);
819     if (di.pci_dev && memcmp(&dev_info.pci_dev->addr, &di.pci_dev->addr,
820         sizeof(struct rte_pci_addr)) == 0)
821             return format(ret, "/1");   
822         }
823   return ret;
824 }
825
826 static u8 * format_dpdk_device_type (u8 * s, va_list * args)
827 {
828   dpdk_main_t * dm = &dpdk_main;
829   char *dev_type;
830   u32 i = va_arg (*args, u32);
831
832   if (dm->devices[i].dev_type == VNET_DPDK_DEV_KNI) {
833        return format(s, "Kernel NIC Interface");
834   } else if (dm->devices[i].dev_type == VNET_DPDK_DEV_VHOST_USER) {
835        return format(s, "vhost-user interface");
836   }
837
838   switch (dm->devices[i].pmd)
839     {
840     case VNET_DPDK_PMD_E1000EM:
841         dev_type = "Intel 82540EM (e1000)";
842         break;
843
844     case VNET_DPDK_PMD_IGB:
845         dev_type = "Intel e1000";
846         break;
847
848     case VNET_DPDK_PMD_I40E:
849         dev_type = "Intel X710/XL710 Family";
850         break;
851
852     case VNET_DPDK_PMD_I40EVF:
853         dev_type = "Intel X710/XL710 Family VF";
854         break;
855
856     case VNET_DPDK_PMD_FM10K:
857         dev_type = "Intel FM10000 Family Ethernet Switch";
858         break;
859
860     case VNET_DPDK_PMD_IGBVF:
861         dev_type = "Intel e1000 VF";
862         break;
863
864     case VNET_DPDK_PMD_VIRTIO:
865         dev_type = "Red Hat Virtio";
866         break;
867
868     case VNET_DPDK_PMD_IXGBEVF:
869         dev_type = "Intel 82599 VF";
870         break;
871
872     case VNET_DPDK_PMD_IXGBE:
873         dev_type = "Intel 82599";
874         break;
875
876     case VNET_DPDK_PMD_VICE:
877     case VNET_DPDK_PMD_ENIC:
878         dev_type = "Cisco VIC";
879         break;
880
881     case VNET_DPDK_PMD_CXGBE:
882         dev_type = "Chelsio T4/T5";
883         break;
884
885     case VNET_DPDK_PMD_VMXNET3:
886         dev_type = "VMware VMXNET3";
887         break;
888
889 #ifdef NETMAP
890     case VNET_DPDK_PMD_NETMAP:
891         dev_type = "Netmap/Vale";
892         break;
893 #endif
894
895     case VNET_DPDK_PMD_AF_PACKET:
896   dev_type = "af_packet";
897   break;
898
899     default:
900     case VNET_DPDK_PMD_UNKNOWN:
901         dev_type = "### UNKNOWN ###";
902         break;
903     }
904
905   return format (s, dev_type);
906 }
907
908 static u8 * format_dpdk_link_status (u8 * s, va_list * args)
909 {
910   dpdk_device_t * xd = va_arg (*args, dpdk_device_t *);
911   struct rte_eth_link * l = &xd->link;
912   vnet_main_t * vnm = vnet_get_main();
913   vnet_hw_interface_t * hi = vnet_get_hw_interface (vnm, xd->vlib_hw_if_index);
914   
915   s = format (s, "%s ", l->link_status ? "up" : "down");
916   if (l->link_status)
917     {
918       u32 promisc = rte_eth_promiscuous_get (xd->device_index);
919
920       s = format (s, "%s duplex ", (l->link_duplex == ETH_LINK_FULL_DUPLEX) ?
921                   "full" : "half");
922       s = format (s, "speed %u mtu %d %s\n", l->link_speed,
923                   hi->max_packet_bytes, promisc ? " promisc" : "");
924     }
925   else
926     s = format (s, "\n");
927
928   return s;
929 }
930
931 #define _line_len 72
932 #define _(v, str)                                            \
933 if (bitmap & v) {                                            \
934   if (format_get_indent (s) > next_split ) {                 \
935     next_split += _line_len;                                 \
936     s = format(s,"\n%U", format_white_space, indent);        \
937   }                                                          \
938   s = format(s, "%s ", str);                                 \
939 }
940
941 static u8 * format_dpdk_rss_hf_name(u8 * s, va_list * args)
942 {
943   u64 bitmap = va_arg (*args, u64);
944   int next_split = _line_len;
945   int indent = format_get_indent (s);
946
947   if (!bitmap)
948     return format(s, "none");
949
950   foreach_dpdk_rss_hf
951
952   return s;
953 }
954
955 static u8 * format_dpdk_rx_offload_caps(u8 * s, va_list * args)
956 {
957   u32 bitmap = va_arg (*args, u32);
958   int next_split = _line_len;
959   int indent = format_get_indent (s);
960
961   if (!bitmap)
962     return format(s, "none");
963
964   foreach_dpdk_rx_offload_caps
965
966   return s;
967 }
968
969 static u8 * format_dpdk_tx_offload_caps(u8 * s, va_list * args)
970 {
971   u32 bitmap = va_arg (*args, u32);
972   int next_split = _line_len;
973   int indent = format_get_indent (s);
974   if (!bitmap)
975     return format(s, "none");
976
977   foreach_dpdk_tx_offload_caps
978
979   return s;
980 }
981
982 #undef _line_len
983 #undef _
984
985 static u8 * format_dpdk_device (u8 * s, va_list * args)
986 {
987   u32 dev_instance = va_arg (*args, u32);
988   int verbose = va_arg (*args, int);
989   dpdk_main_t * dm = &dpdk_main;
990   dpdk_device_t * xd = vec_elt_at_index (dm->devices, dev_instance);
991   uword indent = format_get_indent (s);
992   f64 now = vlib_time_now (dm->vlib_main);
993
994   dpdk_update_counters (xd, now);
995   dpdk_update_link_state (xd, now);
996
997   s = format (s, "%U\n%Ucarrier %U",
998               format_dpdk_device_type, xd->device_index,
999               format_white_space, indent + 2,
1000               format_dpdk_link_status, xd);
1001
1002   if (verbose > 1 && xd->dev_type == VNET_DPDK_DEV_ETH)
1003     {
1004       struct rte_eth_dev_info di;
1005       struct rte_pci_device * pci;
1006       struct rte_eth_rss_conf rss_conf;
1007       int vlan_off;
1008
1009       rss_conf.rss_key = 0;
1010       rte_eth_dev_info_get(xd->device_index, &di);
1011       rte_eth_dev_rss_hash_conf_get(xd->device_index, &rss_conf);
1012       pci = di.pci_dev;
1013
1014       if (pci)
1015         s = format(s, "%Upci id:            device %04x:%04x subsystem %04x:%04x\n"
1016                       "%Upci address:       %04x:%02x:%02x.%02x\n",
1017                    format_white_space, indent + 2,
1018                    pci->id.vendor_id, pci->id.device_id,
1019                    pci->id.subsystem_vendor_id,
1020                    pci->id.subsystem_device_id,
1021                    format_white_space, indent + 2,
1022                    pci->addr.domain, pci->addr.bus,
1023                    pci->addr.devid, pci->addr.function);
1024       s = format(s, "%Umax rx packet len: %d\n",
1025                  format_white_space, indent + 2, di.max_rx_pktlen);
1026       s = format(s, "%Upromiscuous:       unicast %s all-multicast %s\n",
1027                  format_white_space, indent + 2,
1028                  rte_eth_promiscuous_get(xd->device_index) ? "on" : "off",
1029                  rte_eth_promiscuous_get(xd->device_index) ? "on" : "off");
1030       vlan_off = rte_eth_dev_get_vlan_offload(xd->device_index);
1031       s = format(s, "%Uvlan offload:      strip %s filter %s qinq %s\n",
1032                  format_white_space, indent + 2,
1033                  vlan_off & ETH_VLAN_STRIP_OFFLOAD ? "on" : "off",
1034                  vlan_off & ETH_VLAN_FILTER_OFFLOAD ? "on" : "off",
1035                  vlan_off & ETH_VLAN_EXTEND_OFFLOAD ? "on" : "off");
1036       s = format(s, "%Uqueue size (max):  rx %d (%d) tx %d (%d)\n",
1037                  format_white_space, indent + 2,
1038                  xd->rx_q_used, di.max_rx_queues,
1039                  xd->tx_q_used, di.max_tx_queues);
1040       s = format(s, "%Urx offload caps:   %U\n",
1041                  format_white_space, indent + 2,
1042                  format_dpdk_rx_offload_caps, di.rx_offload_capa);
1043       s = format(s, "%Utx offload caps:   %U\n",
1044                  format_white_space, indent + 2,
1045                  format_dpdk_tx_offload_caps, di.tx_offload_capa);
1046       s = format(s, "%Urss active:        %U\n"
1047                     "%Urss supported:     %U\n",
1048                  format_white_space, indent + 2,
1049                  format_dpdk_rss_hf_name, rss_conf.rss_hf,
1050                  format_white_space, indent + 2,
1051                  format_dpdk_rss_hf_name, di.flow_type_rss_offloads);
1052     }
1053
1054   if (xd->cpu_socket > -1)
1055     s = format (s, "%Ucpu socket %d",
1056                 format_white_space, indent + 2,
1057                 xd->cpu_socket);
1058
1059   /* $$$ MIB counters  */
1060
1061   {
1062 #define _(N, V)                                                 \
1063     if (xd->stats.V != 0)                                       \
1064       s = format (s, "\n%U%-40U%16Ld",                          \
1065                   format_white_space, indent + 2,               \
1066                   format_c_identifier, #N, xd->stats.V);
1067     
1068     foreach_dpdk_counter
1069 #undef _
1070   }
1071
1072   u8 * xs = 0;
1073   struct rte_eth_xstats * xstat;
1074
1075   vec_foreach(xstat, xd->xstats)
1076     {
1077       if (xstat->value)
1078         {
1079           /* format_c_identifier don't like c strings inside vector */
1080           u8 * name = format(0,"%s", xstat->name);
1081           xs = format(xs, "\n%U%-38U%16Ld",
1082                       format_white_space, indent + 4,
1083                       format_c_identifier, name, xstat->value);
1084           vec_free(name);
1085         }
1086     }
1087
1088   if (xs)
1089     {
1090       s = format(s, "\n%Uextended stats:%v",
1091                  format_white_space, indent + 2, xs);
1092       vec_free(xs);
1093     }
1094
1095   return s;
1096 }
1097
1098 static u8 * format_dpdk_tx_dma_trace (u8 * s, va_list * va)
1099 {
1100   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
1101   CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *);
1102   CLIB_UNUSED (vnet_main_t * vnm) = vnet_get_main();
1103   dpdk_tx_dma_trace_t * t = va_arg (*va, dpdk_tx_dma_trace_t *);
1104   dpdk_main_t * dm = &dpdk_main;
1105   dpdk_device_t * xd = vec_elt_at_index (dm->devices, t->device_index);
1106   uword indent = format_get_indent (s);
1107   vnet_sw_interface_t * sw = vnet_get_sw_interface (vnm, xd->vlib_sw_if_index);
1108
1109   s = format (s, "%U tx queue %d",
1110               format_vnet_sw_interface_name, vnm, sw,
1111               t->queue_index);
1112
1113   s = format (s, "\n%Ubuffer 0x%x: %U",
1114               format_white_space, indent,
1115               t->buffer_index,
1116               format_vlib_buffer, &t->buffer);
1117
1118   s = format (s, "\n%U%U", format_white_space, indent,
1119               format_ethernet_header_with_length, t->buffer.pre_data,
1120               sizeof (t->buffer.pre_data));
1121   
1122   return s;
1123 }
1124
1125 static void dpdk_clear_hw_interface_counters (u32 instance)
1126 {
1127   dpdk_main_t * dm = &dpdk_main;
1128   dpdk_device_t * xd = vec_elt_at_index (dm->devices, instance);
1129
1130   /*
1131    * DAW-FIXME: VMXNET3 device stop/start doesn't work, 
1132    * therefore fake the stop in the dpdk driver by
1133    * silently dropping all of the incoming pkts instead of 
1134    * stopping the driver / hardware.
1135    */
1136   if (xd->admin_up != 0xff)
1137     {
1138       rte_eth_stats_reset (xd->device_index);
1139       memset (&xd->last_stats, 0, sizeof (xd->last_stats));
1140       dpdk_update_counters (xd, vlib_time_now (dm->vlib_main));
1141     }
1142   else
1143     {
1144       rte_eth_stats_reset (xd->device_index);
1145       memset(&xd->stats, 0, sizeof(xd->stats));
1146       memset (&xd->last_stats, 0, sizeof (xd->last_stats));
1147     }
1148   rte_eth_xstats_reset(xd->device_index);
1149 }
1150
1151 static int
1152 kni_config_network_if(u8 port_id, u8 if_up)
1153 {
1154   vnet_main_t * vnm = vnet_get_main();
1155   dpdk_main_t * dm = &dpdk_main;
1156   dpdk_device_t * xd;
1157   uword *p;
1158
1159   p = hash_get (dm->dpdk_device_by_kni_port_id, port_id);
1160   if (p == 0) {
1161     clib_warning("unknown interface");
1162     return 0;
1163   } else {
1164     xd = vec_elt_at_index (dm->devices, p[0]);
1165   }
1166
1167   vnet_hw_interface_set_flags (vnm, xd->vlib_hw_if_index,
1168                                if_up ? VNET_HW_INTERFACE_FLAG_LINK_UP |
1169                                ETH_LINK_FULL_DUPLEX : 0);
1170   return 0;
1171 }
1172
1173 static int
1174 kni_change_mtu(u8 port_id, unsigned new_mtu)
1175 {
1176   vnet_main_t * vnm = vnet_get_main();
1177   dpdk_main_t * dm = &dpdk_main;
1178   dpdk_device_t * xd;
1179   uword *p;
1180   vnet_hw_interface_t * hif;
1181
1182   p = hash_get (dm->dpdk_device_by_kni_port_id, port_id);
1183   if (p == 0) {
1184     clib_warning("unknown interface");
1185     return 0;
1186   } else {
1187     xd = vec_elt_at_index (dm->devices, p[0]);
1188   }
1189   hif = vnet_get_hw_interface (vnm, xd->vlib_hw_if_index);
1190
1191   hif->max_packet_bytes = new_mtu;
1192
1193   return 0;
1194 }
1195
1196 static clib_error_t *
1197 dpdk_interface_admin_up_down (vnet_main_t * vnm, u32 hw_if_index, u32 flags)
1198 {
1199   vnet_hw_interface_t * hif = vnet_get_hw_interface (vnm, hw_if_index);
1200   uword is_up = (flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) != 0;
1201   dpdk_main_t * dm = &dpdk_main;
1202   dpdk_device_t * xd = vec_elt_at_index (dm->devices, hif->dev_instance);
1203   int rv = 0;
1204
1205   if (xd->dev_type == VNET_DPDK_DEV_KNI)
1206   {
1207       if (is_up)
1208       {
1209           struct rte_kni_conf conf;
1210           struct rte_kni_ops ops;
1211           vlib_main_t * vm = vlib_get_main();
1212           vlib_buffer_main_t * bm = vm->buffer_main;
1213           memset(&conf, 0, sizeof(conf));
1214           snprintf(conf.name, RTE_KNI_NAMESIZE, "vpp%u", xd->kni_port_id);
1215           conf.mbuf_size = MBUF_SIZE;
1216           memset(&ops, 0, sizeof(ops));
1217           ops.port_id = xd->kni_port_id;
1218           ops.change_mtu = kni_change_mtu;
1219           ops.config_network_if = kni_config_network_if;
1220
1221           xd->kni = rte_kni_alloc(bm->pktmbuf_pools[rte_socket_id()], &conf, &ops);
1222           if (!xd->kni)
1223           {
1224             clib_warning("failed to allocate kni interface");
1225           }
1226           else
1227           {
1228             hif->max_packet_bytes = 1500; /* kni interface default value */
1229             xd->admin_up = 1;
1230           }
1231       }
1232       else
1233       {
1234         xd->admin_up = 0;
1235         rte_kni_release(xd->kni);
1236       }
1237       return 0;
1238   }
1239   if (xd->dev_type == VNET_DPDK_DEV_VHOST_USER)
1240     {
1241       if (is_up)
1242         {
1243           if (xd->vu_is_running)
1244             vnet_hw_interface_set_flags (vnm, xd->vlib_hw_if_index,
1245                                  VNET_HW_INTERFACE_FLAG_LINK_UP |
1246                                  ETH_LINK_FULL_DUPLEX );
1247           xd->admin_up = 1;
1248         }
1249       else
1250         {
1251           vnet_hw_interface_set_flags (vnm, xd->vlib_hw_if_index, 0);
1252                               xd->admin_up = 0;
1253         }
1254
1255       return 0;
1256     }
1257
1258
1259   if (is_up)
1260     {
1261       f64 now = vlib_time_now (dm->vlib_main);
1262
1263       /*
1264        * DAW-FIXME: VMXNET3 device stop/start doesn't work, 
1265        * therefore fake the stop in the dpdk driver by
1266        * silently dropping all of the incoming pkts instead of 
1267        * stopping the driver / hardware.
1268        */
1269       if (xd->admin_up == 0)
1270         rv = rte_eth_dev_start (xd->device_index);
1271
1272       if (xd->promisc)
1273           rte_eth_promiscuous_enable(xd->device_index);
1274       else
1275           rte_eth_promiscuous_disable(xd->device_index);
1276
1277       rte_eth_allmulticast_enable (xd->device_index);
1278       xd->admin_up = 1;
1279       dpdk_update_counters (xd, now);
1280       dpdk_update_link_state (xd, now);
1281     }
1282   else
1283     {
1284       rte_eth_allmulticast_disable (xd->device_index);
1285       vnet_hw_interface_set_flags (vnm, xd->vlib_hw_if_index, 0);
1286
1287       /*
1288        * DAW-FIXME: VMXNET3 device stop/start doesn't work, 
1289        * therefore fake the stop in the dpdk driver by
1290        * silently dropping all of the incoming pkts instead of 
1291        * stopping the driver / hardware.
1292        */
1293       if (xd->pmd != VNET_DPDK_PMD_VMXNET3)
1294         {
1295           rte_eth_dev_stop (xd->device_index);
1296           xd->admin_up = 0;
1297         }
1298       else
1299           xd->admin_up = ~0;
1300     }
1301
1302   if (rv < 0)
1303     clib_warning ("rte_eth_dev_%s error: %d", is_up ? "start" : "stop",
1304                   rv);
1305
1306   return /* no error */ 0;
1307 }
1308
1309 /*
1310  * Dynamically redirect all pkts from a specific interface
1311  * to the specified node
1312  */
1313 static void dpdk_set_interface_next_node (vnet_main_t *vnm, u32 hw_if_index,
1314                                           u32 node_index)
1315 {
1316   dpdk_main_t * xm = &dpdk_main;
1317   vnet_hw_interface_t *hw = vnet_get_hw_interface (vnm, hw_if_index);
1318   dpdk_device_t * xd = vec_elt_at_index (xm->devices, hw->dev_instance);
1319   
1320   /* Shut off redirection */
1321   if (node_index == ~0)
1322     {
1323       xd->per_interface_next_index = node_index;
1324       return;
1325     }
1326   
1327   xd->per_interface_next_index = 
1328     vlib_node_add_next (xm->vlib_main, dpdk_input_node.index, node_index);
1329 }
1330
1331
1332 static clib_error_t *
1333 dpdk_subif_add_del_function (vnet_main_t * vnm,
1334                              u32 hw_if_index,
1335                              struct vnet_sw_interface_t * st,
1336                              int is_add)
1337 {
1338   dpdk_main_t * xm = &dpdk_main;
1339   vnet_hw_interface_t *hw = vnet_get_hw_interface (vnm, hw_if_index);
1340   dpdk_device_t * xd = vec_elt_at_index (xm->devices, hw->dev_instance);
1341   vnet_sw_interface_t * t = (vnet_sw_interface_t *) st;
1342   int r, vlan_offload;
1343
1344
1345   if (xd->dev_type != VNET_DPDK_DEV_ETH)
1346         return 0;
1347   /* currently we program VLANS only for IXGBE VF */
1348   if (xd->pmd != VNET_DPDK_PMD_IXGBEVF)
1349         return 0;
1350
1351   if (t->sub.eth.flags.no_tags == 1)
1352         return 0;
1353
1354   if ((t->sub.eth.flags.one_tag != 1) || (t->sub.eth.flags.exact_match != 1 ))
1355         return clib_error_return (0, "unsupported VLAN setup");
1356
1357
1358   vlan_offload = rte_eth_dev_get_vlan_offload(xd->device_index);
1359   vlan_offload |= ETH_VLAN_FILTER_OFFLOAD;
1360
1361   if ((r = rte_eth_dev_set_vlan_offload(xd->device_index, vlan_offload)))
1362         return clib_error_return (0, "rte_eth_dev_set_vlan_offload[%d]: err %d",
1363                                   xd->device_index, r);
1364
1365
1366   if ((r = rte_eth_dev_vlan_filter(xd->device_index, t->sub.eth.outer_vlan_id, is_add)))
1367         return clib_error_return (0, "rte_eth_dev_vlan_filter[%d]: err %d",
1368                                  xd->device_index, r);
1369
1370   return 0;
1371 }
1372
1373 VNET_DEVICE_CLASS (dpdk_device_class) = {
1374   .name = "dpdk",
1375   .tx_function = dpdk_interface_tx,
1376   .tx_function_n_errors = DPDK_TX_FUNC_N_ERROR,
1377   .tx_function_error_strings = dpdk_tx_func_error_strings,
1378   .format_device_name = format_dpdk_device_name,
1379   .format_device = format_dpdk_device,
1380   .format_tx_trace = format_dpdk_tx_dma_trace,
1381   .clear_counters = dpdk_clear_hw_interface_counters,
1382   .admin_up_down_function = dpdk_interface_admin_up_down,
1383   .subif_add_del_function = dpdk_subif_add_del_function,
1384   .rx_redirect_to_node = dpdk_set_interface_next_node,
1385   .no_flatten_output_chains = 1,
1386   .name_renumber = dpdk_device_renumber,
1387 };
1388
1389 void dpdk_set_flowcontrol_callback (vlib_main_t *vm, 
1390                                     dpdk_flowcontrol_callback_t callback)
1391 {
1392   dpdk_main.flowcontrol_callback = callback;
1393 }
1394
1395 #define UP_DOWN_FLAG_EVENT 1
1396
1397
1398 u32 dpdk_get_admin_up_down_in_progress (void)
1399 {
1400   return dpdk_main.admin_up_down_in_progress;
1401 }
1402
1403 static uword
1404 admin_up_down_process (vlib_main_t * vm,
1405                        vlib_node_runtime_t * rt,
1406                        vlib_frame_t * f)
1407 {
1408   clib_error_t * error = 0;
1409   uword event_type;
1410   uword *event_data = 0;
1411   u32 index;
1412   u32 sw_if_index;
1413   u32 flags;
1414
1415   while (1)  
1416     { 
1417       vlib_process_wait_for_event (vm);
1418
1419       event_type = vlib_process_get_events (vm, &event_data);
1420
1421       dpdk_main.admin_up_down_in_progress = 1;
1422
1423       for (index=0; index<vec_len(event_data); index++)
1424         {
1425           sw_if_index = event_data[index] >> 32;
1426           flags = (u32) event_data[index];
1427
1428           switch (event_type) {
1429           case UP_DOWN_FLAG_EVENT:
1430             error = vnet_sw_interface_set_flags (vnet_get_main(), sw_if_index, flags);
1431             clib_error_report(error);
1432             break;
1433           }
1434         }
1435
1436       vec_reset_length (event_data);
1437
1438       dpdk_main.admin_up_down_in_progress = 0;
1439
1440     }
1441   return 0; /* or not */
1442 }
1443
1444 VLIB_REGISTER_NODE (admin_up_down_process_node,static) = {
1445     .function = admin_up_down_process,
1446     .type = VLIB_NODE_TYPE_PROCESS,
1447     .name = "admin-up-down-process",
1448     .process_log2_n_stack_bytes = 17,  // 256KB
1449 };
1450
1451 /*
1452  * Asynchronously invoke vnet_sw_interface_set_flags via the admin_up_down 
1453  * process. Useful for avoiding long blocking delays (>150ms) in the dpdk 
1454  * drivers.
1455  * WARNING: when posting this event, no other interface-related calls should
1456  * be made (e.g. vnet_create_sw_interface()) while the event is being
1457  * processed (admin_up_down_in_progress). This is required in order to avoid 
1458  * race conditions in manipulating interface data structures.
1459  */
1460 void post_sw_interface_set_flags (vlib_main_t *vm, u32 sw_if_index, u32 flags)
1461 {
1462   vlib_process_signal_event
1463       (vm, admin_up_down_process_node.index,
1464        UP_DOWN_FLAG_EVENT, 
1465        (((uword)sw_if_index << 32) | flags));
1466 }
1467
1468 /*
1469  * Called by the dpdk driver's rte_delay_us() function. 
1470  * Return 0 to have the dpdk do a regular delay loop.
1471  * Return 1 if to skip the delay loop because we are suspending
1472  * the calling vlib process instead.
1473  */
1474 int rte_delay_us_override (unsigned us) {
1475   vlib_main_t * vm;
1476
1477   /* Don't bother intercepting for short delays */
1478   if (us < 10) return 0;
1479
1480   /* 
1481    * Only intercept if we are in a vlib process. 
1482    * If we are called from a vlib worker thread or the vlib main
1483    * thread then do not intercept. (Must not be called from an 
1484    * independent pthread).
1485    */
1486   if (os_get_cpu_number() == 0)
1487     {
1488       /* 
1489        * We're in the vlib main thread or a vlib process. Make sure
1490        * the process is running and we're not still initializing.
1491        */
1492       vm = vlib_get_main();
1493       if (vlib_in_process_context(vm))
1494         {
1495           /* Only suspend for the admin_down_process */
1496           vlib_process_t * proc = vlib_get_current_process(vm);
1497           if (!(proc->flags & VLIB_PROCESS_IS_RUNNING) ||
1498               (proc->node_runtime.function != admin_up_down_process))
1499                 return 0;
1500
1501           f64 delay = 1e-6 * us;
1502           vlib_process_suspend(vm, delay);
1503           return 1;
1504         }
1505     }
1506   return 0; // no override
1507 }