src/vnet/interface_output.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 /*
  16  * interface_output.c: interface output node
  17  *
  18  * Copyright (c) 2008 Eliot Dresselhaus
  19  *
  20  * Permission is hereby granted, free of charge, to any person obtaining
  21  * a copy of this software and associated documentation files (the
  22  * "Software"), to deal in the Software without restriction, including
  23  * without limitation the rights to use, copy, modify, merge, publish,
  24  * distribute, sublicense, and/or sell copies of the Software, and to
  25  * permit persons to whom the Software is furnished to do so, subject to
  26  * the following conditions:
  27  *
  28  * The above copyright notice and this permission notice shall be
  29  * included in all copies or substantial portions of the Software.
  30  *
  31  *  THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  32  *  EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  33  *  MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  34  *  NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
  35  *  LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
  36  *  OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
  37  *  WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  38  */
  39
  40 #include <vnet/vnet.h>
  41 #include <vnet/ip/icmp46_packet.h>
  42 #include <vnet/ethernet/packet.h>
  43 #include <vnet/ip/format.h>
  44 #include <vnet/ip/ip4.h>
  45 #include <vnet/ip/ip6.h>
  46 #include <vnet/udp/udp_packet.h>
  47 #include <vnet/feature/feature.h>
  48 #include <vnet/classify/pcap_classify.h>
  49 #include <vnet/hash/hash.h>
  50 #include <vnet/interface_output.h>
  51 #include <vppinfra/vector/mask_compare.h>
  52 #include <vppinfra/vector/compress.h>
  53 #include <vppinfra/vector/count_equal.h>
  54 #include <vppinfra/vector/array_mask.h>
  55
  56 typedef struct
  57 {
  58   u32 sw_if_index;
  59   u32 flags;
  60   u8 data[128 - 2 * sizeof (u32)];
  61 }
  62 interface_output_trace_t;
  63
  64 #ifndef CLIB_MARCH_VARIANT
  65 u8 *
  66 format_vnet_interface_output_trace (u8 * s, va_list * va)
  67 {
  68   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
  69   vlib_node_t *node = va_arg (*va, vlib_node_t *);
  70   interface_output_trace_t *t = va_arg (*va, interface_output_trace_t *);
  71   vnet_main_t *vnm = vnet_get_main ();
  72   vnet_sw_interface_t *si;
  73   u32 indent;
  74
  75   if (t->sw_if_index != (u32) ~ 0)
  76     {
  77       indent = format_get_indent (s);
  78
  79       if (pool_is_free_index
  80           (vnm->interface_main.sw_interfaces, t->sw_if_index))
  81         {
  82           /* the interface may have been deleted by the time the trace is printed */
  83           s = format (s, "sw_if_index: %d ", t->sw_if_index);
  84         }
  85       else
  86         {
  87           si = vnet_get_sw_interface (vnm, t->sw_if_index);
  88           s =
  89             format (s, "%U ", format_vnet_sw_interface_name, vnm, si,
  90                     t->flags);
  91         }
  92       s =
  93         format (s, "\n%U%U", format_white_space, indent,
  94                 node->format_buffer ? node->format_buffer : format_hex_bytes,
  95                 t->data, sizeof (t->data));
  96     }
  97   return s;
  98 }
  99 #endif /* CLIB_MARCH_VARIANT */
 100
 101 static void
 102 vnet_interface_output_trace (vlib_main_t * vm,
 103                              vlib_node_runtime_t * node,
 104                              vlib_frame_t * frame, uword n_buffers)
 105 {
 106   u32 n_left, *from;
 107
 108   n_left = n_buffers;
 109   from = vlib_frame_vector_args (frame);
 110
 111   while (n_left >= 4)
 112     {
 113       u32 bi0, bi1;
 114       vlib_buffer_t *b0, *b1;
 115       interface_output_trace_t *t0, *t1;
 116
 117       /* Prefetch next iteration. */
 118       vlib_prefetch_buffer_with_index (vm, from[2], LOAD);
 119       vlib_prefetch_buffer_with_index (vm, from[3], LOAD);
 120
 121       bi0 = from[0];
 122       bi1 = from[1];
 123
 124       b0 = vlib_get_buffer (vm, bi0);
 125       b1 = vlib_get_buffer (vm, bi1);
 126
 127       if (b0->flags & VLIB_BUFFER_IS_TRACED)
 128         {
 129           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
 130           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX];
 131           t0->flags = b0->flags;
 132           clib_memcpy_fast (t0->data, vlib_buffer_get_current (b0),
 133                             sizeof (t0->data));
 134         }
 135       if (b1->flags & VLIB_BUFFER_IS_TRACED)
 136         {
 137           t1 = vlib_add_trace (vm, node, b1, sizeof (t1[0]));
 138           t1->sw_if_index = vnet_buffer (b1)->sw_if_index[VLIB_TX];
 139           t1->flags = b1->flags;
 140           clib_memcpy_fast (t1->data, vlib_buffer_get_current (b1),
 141                             sizeof (t1->data));
 142         }
 143       from += 2;
 144       n_left -= 2;
 145     }
 146
 147   while (n_left >= 1)
 148     {
 149       u32 bi0;
 150       vlib_buffer_t *b0;
 151       interface_output_trace_t *t0;
 152
 153       bi0 = from[0];
 154
 155       b0 = vlib_get_buffer (vm, bi0);
 156
 157       if (b0->flags & VLIB_BUFFER_IS_TRACED)
 158         {
 159           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
 160           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX];
 161           t0->flags = b0->flags;
 162           clib_memcpy_fast (t0->data, vlib_buffer_get_current (b0),
 163                             sizeof (t0->data));
 164         }
 165       from += 1;
 166       n_left -= 1;
 167     }
 168 }
 169
 170 static_always_inline void
 171 vnet_interface_output_handle_offload (vlib_main_t *vm, vlib_buffer_t *b)
 172 {
 173   vnet_calc_checksums_inline (vm, b, b->flags & VNET_BUFFER_F_IS_IP4,
 174                               b->flags & VNET_BUFFER_F_IS_IP6);
 175   vnet_calc_outer_checksums_inline (vm, b);
 176 }
 177
 178 static_always_inline uword
 179 vnet_interface_output_node_inline (vlib_main_t *vm, u32 sw_if_index,
 180                                    vlib_combined_counter_main_t *ccm,
 181                                    vlib_buffer_t **b, void **p,
 182                                    u32 config_index, u8 arc, u32 n_left,
 183                                    int processing_level)
 184 {
 185   u32 n_bytes = 0;
 186   u32 n_bytes0, n_bytes1, n_bytes2, n_bytes3;
 187   u32 ti = vm->thread_index;
 188
 189   while (n_left >= 8)
 190     {
 191       u32 or_flags;
 192
 193       /* Prefetch next iteration. */
 194       vlib_prefetch_buffer_header (b[4], LOAD);
 195       vlib_prefetch_buffer_header (b[5], LOAD);
 196       vlib_prefetch_buffer_header (b[6], LOAD);
 197       vlib_prefetch_buffer_header (b[7], LOAD);
 198
 199       if (processing_level >= 1)
 200         or_flags = b[0]->flags | b[1]->flags | b[2]->flags | b[3]->flags;
 201
 202       /* Be grumpy about zero length buffers for benefit of
 203          driver tx function. */
 204       ASSERT (b[0]->current_length > 0);
 205       ASSERT (b[1]->current_length > 0);
 206       ASSERT (b[2]->current_length > 0);
 207       ASSERT (b[3]->current_length > 0);
 208
 209       n_bytes += n_bytes0 = vlib_buffer_length_in_chain (vm, b[0]);
 210       n_bytes += n_bytes1 = vlib_buffer_length_in_chain (vm, b[1]);
 211       n_bytes += n_bytes2 = vlib_buffer_length_in_chain (vm, b[2]);
 212       n_bytes += n_bytes3 = vlib_buffer_length_in_chain (vm, b[3]);
 213
 214       if (processing_level >= 3)
 215         {
 216           p[0] = vlib_buffer_get_current (b[0]);
 217           p[1] = vlib_buffer_get_current (b[1]);
 218           p[2] = vlib_buffer_get_current (b[2]);
 219           p[3] = vlib_buffer_get_current (b[3]);
 220           p += 4;
 221         }
 222
 223       if (processing_level >= 2)
 224         {
 225           u32 tx_swif0, tx_swif1, tx_swif2, tx_swif3;
 226           tx_swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
 227           tx_swif1 = vnet_buffer (b[1])->sw_if_index[VLIB_TX];
 228           tx_swif2 = vnet_buffer (b[2])->sw_if_index[VLIB_TX];
 229           tx_swif3 = vnet_buffer (b[3])->sw_if_index[VLIB_TX];
 230
 231           /* update vlan subif tx counts, if required */
 232           if (PREDICT_FALSE (tx_swif0 != sw_if_index))
 233             vlib_increment_combined_counter (ccm, ti, tx_swif0, 1, n_bytes0);
 234
 235           if (PREDICT_FALSE (tx_swif1 != sw_if_index))
 236             vlib_increment_combined_counter (ccm, ti, tx_swif1, 1, n_bytes1);
 237
 238           if (PREDICT_FALSE (tx_swif2 != sw_if_index))
 239             vlib_increment_combined_counter (ccm, ti, tx_swif2, 1, n_bytes2);
 240
 241           if (PREDICT_FALSE (tx_swif3 != sw_if_index))
 242             vlib_increment_combined_counter (ccm, ti, tx_swif3, 1, n_bytes3);
 243
 244           if (PREDICT_FALSE (config_index != ~0))
 245             {
 246               vnet_buffer (b[0])->feature_arc_index = arc;
 247               b[0]->current_config_index = config_index;
 248               vnet_buffer (b[1])->feature_arc_index = arc;
 249               b[1]->current_config_index = config_index;
 250               vnet_buffer (b[2])->feature_arc_index = arc;
 251               b[2]->current_config_index = config_index;
 252               vnet_buffer (b[3])->feature_arc_index = arc;
 253               b[3]->current_config_index = config_index;
 254             }
 255         }
 256
 257       if (processing_level >= 1 && (or_flags & VNET_BUFFER_F_OFFLOAD))
 258         {
 259           vnet_interface_output_handle_offload (vm, b[0]);
 260           vnet_interface_output_handle_offload (vm, b[1]);
 261           vnet_interface_output_handle_offload (vm, b[2]);
 262           vnet_interface_output_handle_offload (vm, b[3]);
 263         }
 264
 265       n_left -= 4;
 266       b += 4;
 267     }
 268
 269   while (n_left)
 270     {
 271       /* Be grumpy about zero length buffers for benefit of
 272          driver tx function. */
 273       ASSERT (b[0]->current_length > 0);
 274
 275       n_bytes += n_bytes0 = vlib_buffer_length_in_chain (vm, b[0]);
 276
 277       if (processing_level >= 3)
 278         {
 279           p[0] = vlib_buffer_get_current (b[0]);
 280           p += 1;
 281         }
 282
 283       if (processing_level >= 2)
 284         {
 285           u32 tx_swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
 286
 287           if (PREDICT_FALSE (config_index != ~0))
 288             {
 289               vnet_buffer (b[0])->feature_arc_index = arc;
 290               b[0]->current_config_index = config_index;
 291             }
 292
 293           if (PREDICT_FALSE (tx_swif0 != sw_if_index))
 294             vlib_increment_combined_counter (ccm, ti, tx_swif0, 1, n_bytes0);
 295         }
 296
 297       if (processing_level >= 1)
 298         vnet_interface_output_handle_offload (vm, b[0]);
 299
 300       n_left -= 1;
 301       b += 1;
 302     }
 303
 304   return n_bytes;
 305 }
 306
 307 static_always_inline void
 308 vnet_interface_pcap_tx_trace (vlib_main_t *vm, vlib_node_runtime_t *node,
 309                               vlib_frame_t *frame, int in_interface_ouput)
 310 {
 311   vnet_main_t *vnm = vnet_get_main ();
 312   u32 n_left_from, *from;
 313   u32 sw_if_index = ~0, hw_if_index = ~0;
 314   vnet_pcap_t *pp = &vnm->pcap;
 315
 316   if (PREDICT_TRUE (pp->pcap_tx_enable == 0))
 317     return;
 318
 319   if (in_interface_ouput)
 320     {
 321       /* interface-output is called right before interface-output-template.
 322        * We only want to capture packets here if there is a per-interface
 323        * filter, in case it matches the sub-interface sw_if_index.
 324        * If there is no per-interface filter configured, let the
 325        * interface-output-template node deal with it */
 326       if (pp->pcap_sw_if_index == 0)
 327         return;
 328     }
 329   else
 330     {
 331       vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
 332       sw_if_index = rt->sw_if_index;
 333     }
 334
 335   n_left_from = frame->n_vectors;
 336   from = vlib_frame_vector_args (frame);
 337
 338   while (n_left_from > 0)
 339     {
 340       u32 bi0 = from[0];
 341       vlib_buffer_t *b0 = vlib_get_buffer (vm, bi0);
 342       from++;
 343       n_left_from--;
 344
 345       if (in_interface_ouput)
 346         {
 347           const u32 sii = vnet_buffer (b0)->sw_if_index[VLIB_TX];
 348           if (PREDICT_FALSE (sii != sw_if_index))
 349             {
 350               const vnet_hw_interface_t *hi =
 351                 vnet_get_sup_hw_interface (vnm, sii);
 352               hw_if_index = hi->sw_if_index;
 353               sw_if_index = sii;
 354             }
 355           if (hw_if_index == sw_if_index)
 356             continue; /* defer to interface-output-template */
 357         }
 358
 359       if (vnet_is_packet_pcaped (pp, b0, sw_if_index))
 360         pcap_add_buffer (&pp->pcap_main, vm, bi0, pp->max_bytes_per_pkt);
 361     }
 362 }
 363
 364 static_always_inline void
 365 hash_func_with_mask (void **p, u32 *hash, u32 n_packets, u32 *lookup_table,
 366                      u32 mask, vnet_hash_fn_t hf)
 367 {
 368   u32 n_left_from = n_packets;
 369
 370   hf (p, hash, n_packets);
 371
 372   clib_array_mask_u32 (hash, mask, n_packets);
 373
 374   while (n_left_from >= 4)
 375     {
 376       hash[0] = lookup_table[hash[0]];
 377       hash[1] = lookup_table[hash[1]];
 378       hash[2] = lookup_table[hash[2]];
 379       hash[3] = lookup_table[hash[3]];
 380
 381       hash += 4;
 382       n_left_from -= 4;
 383     }
 384
 385   while (n_left_from > 0)
 386     {
 387       hash[0] = lookup_table[hash[0]];
 388
 389       hash += 1;
 390       n_left_from -= 1;
 391     }
 392 }
 393
 394 static_always_inline void
 395 store_tx_frame_scalar_data (vnet_hw_if_tx_frame_t *copy_frame,
 396                             vnet_hw_if_tx_frame_t *tf)
 397 {
 398   if (copy_frame)
 399     clib_memcpy_fast (tf, copy_frame, sizeof (vnet_hw_if_tx_frame_t));
 400 }
 401
 402 static_always_inline u32
 403 enqueue_one_to_tx_node (vlib_main_t *vm, vlib_node_runtime_t *node, u32 *ppqi,
 404                         u32 *from, vnet_hw_if_tx_frame_t *copy_frame,
 405                         u32 n_vectors, u32 n_left, u32 next_index)
 406 {
 407   u32 tmp[VLIB_FRAME_SIZE];
 408   u64 mask[VLIB_FRAME_SIZE / 64] = {};
 409   vlib_frame_t *f;
 410   vnet_hw_if_tx_frame_t *tf;
 411   u32 *to;
 412   u32 n_copy = 0, n_free = 0;
 413
 414   f = vlib_get_next_frame_internal (vm, node, next_index, 0);
 415   tf = vlib_frame_scalar_args (f);
 416
 417   if (f->n_vectors > 0 &&
 418       (!copy_frame || (tf->queue_id == copy_frame->queue_id)))
 419     {
 420       /* append current next frame */
 421       n_free = VLIB_FRAME_SIZE - f->n_vectors;
 422       /*
 423        * if frame contains enough space for worst case scenario,
 424        * we can avoid use of tmp
 425        */
 426       if (n_free >= n_left)
 427         to = (u32 *) vlib_frame_vector_args (f) + f->n_vectors;
 428       else
 429         to = tmp;
 430     }
 431   else
 432     {
 433       if (f->n_vectors > 0)
 434         {
 435           /* current frame doesn't fit - grab empty one */
 436           f = vlib_get_next_frame_internal (vm, node, next_index, 1);
 437           tf = vlib_frame_scalar_args (f);
 438         }
 439
 440       /* empty frame - store scalar data */
 441       store_tx_frame_scalar_data (copy_frame, tf);
 442       to = vlib_frame_vector_args (f);
 443       n_free = VLIB_FRAME_SIZE;
 444     }
 445
 446   /*
 447    * per packet queue id array
 448    * compare with given queue_id, if match, copy respective buffer index from
 449    * -> to
 450    */
 451   if (ppqi)
 452     {
 453       clib_mask_compare_u32 (copy_frame->queue_id, ppqi, mask, n_vectors);
 454       n_copy = clib_compress_u32 (to, from, mask, n_vectors);
 455
 456       if (n_copy == 0)
 457         return n_left;
 458     }
 459   else
 460     {
 461       /*
 462        * no work required, just copy all buffer indices from -> to
 463        */
 464       n_copy = n_left;
 465       vlib_buffer_copy_indices (to, from, n_copy);
 466     }
 467
 468   if (to != tmp)
 469     {
 470       /* indices already written to frame, just close it */
 471       vlib_put_next_frame (vm, node, next_index, n_free - n_copy);
 472     }
 473   else if (n_free >= n_copy)
 474     {
 475       /* enough space in the existing frame */
 476       to = (u32 *) vlib_frame_vector_args (f) + f->n_vectors;
 477       vlib_buffer_copy_indices (to, tmp, n_copy);
 478       vlib_put_next_frame (vm, node, next_index, n_free - n_copy);
 479     }
 480   else
 481     {
 482       /* full frame */
 483       to = (u32 *) vlib_frame_vector_args (f) + f->n_vectors;
 484       vlib_buffer_copy_indices (to, tmp, n_free);
 485       vlib_put_next_frame (vm, node, next_index, 0);
 486
 487       /* second frame */
 488       u32 n_2nd_frame = n_copy - n_free;
 489       f = vlib_get_next_frame_internal (vm, node, next_index, 1);
 490       tf = vlib_frame_scalar_args (f);
 491       /* empty frame - store scalar data */
 492       store_tx_frame_scalar_data (copy_frame, tf);
 493       to = vlib_frame_vector_args (f);
 494       vlib_buffer_copy_indices (to, tmp + n_free, n_2nd_frame);
 495       vlib_put_next_frame (vm, node, next_index,
 496                            VLIB_FRAME_SIZE - n_2nd_frame);
 497     }
 498
 499   return n_left - n_copy;
 500 }
 501
 502 static_always_inline void
 503 enqueue_to_tx_node (vlib_main_t *vm, vlib_node_runtime_t *node,
 504                     vnet_hw_interface_t *hi, u32 next_index,
 505                     vnet_hw_if_output_node_runtime_t *r, u32 *from, void **p,
 506                     u32 n_vectors)
 507 {
 508   u32 n_left = n_vectors;
 509
 510   ASSERT (n_vectors <= VLIB_FRAME_SIZE);
 511
 512   /*
 513    * backward compatible for drivers not integrated with new tx infra.
 514    */
 515   if (r == 0)
 516     {
 517       n_left = enqueue_one_to_tx_node (vm, node, NULL, from, NULL, n_vectors,
 518                                        n_left, next_index);
 519     }
 520   /*
 521    * only 1 tx queue of given interface is available on given thread
 522    */
 523   else if (r->n_queues == 1)
 524     {
 525       n_left = enqueue_one_to_tx_node (vm, node, NULL, from, r->frame,
 526                                        n_vectors, n_left, next_index);
 527     }
 528   /*
 529    * multi tx-queues use case
 530    */
 531   else if (r->n_queues > 1)
 532     {
 533       u32 qids[VLIB_FRAME_SIZE];
 534
 535       hash_func_with_mask (p, qids, n_vectors, r->lookup_table,
 536                            vec_len (r->lookup_table) - 1, hi->hf);
 537
 538       for (u32 i = 0; i < r->n_queues; i++)
 539         {
 540           n_left = enqueue_one_to_tx_node (vm, node, qids, from, &r->frame[i],
 541                                            n_vectors, n_left, next_index);
 542           if (n_left == 0)
 543             break;
 544         }
 545     }
 546   else
 547     ASSERT (0);
 548 }
 549
 550 VLIB_NODE_FN (vnet_interface_output_node)
 551 (vlib_main_t *vm, vlib_node_runtime_t *node, vlib_frame_t *frame)
 552 {
 553   vnet_main_t *vnm = vnet_get_main ();
 554   vnet_interface_main_t *im = &vnm->interface_main;
 555   vlib_combined_counter_main_t *ccm;
 556   vnet_hw_interface_t *hi;
 557   vnet_sw_interface_t *si;
 558   vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
 559   vnet_hw_if_output_node_runtime_t *r = 0;
 560   vlib_buffer_t *bufs[VLIB_FRAME_SIZE];
 561   u32 n_bytes, n_buffers = frame->n_vectors;
 562   u32 config_index = ~0;
 563   u32 sw_if_index = rt->sw_if_index;
 564   u32 next_index = VNET_INTERFACE_OUTPUT_NEXT_TX;
 565   u32 ti = vm->thread_index;
 566   u8 arc = im->output_feature_arc_index;
 567   int arc_or_subif = 0;
 568   int do_tx_offloads = 0;
 569   void *ptr[VLIB_FRAME_SIZE], **p = ptr;
 570   u8 is_parr = 0;
 571   u32 *from;
 572
 573   if (node->flags & VLIB_NODE_FLAG_TRACE)
 574     vnet_interface_output_trace (vm, node, frame, n_buffers);
 575
 576   from = vlib_frame_vector_args (frame);
 577
 578   if (rt->is_deleted)
 579     return vlib_error_drop_buffers (
 580       vm, node, from,
 581       /* buffer stride */ 1, n_buffers, VNET_INTERFACE_OUTPUT_NEXT_DROP,
 582       node->node_index, VNET_INTERFACE_OUTPUT_ERROR_INTERFACE_DELETED);
 583
 584   vnet_interface_pcap_tx_trace (vm, node, frame, 0 /* in_interface_ouput */);
 585
 586   vlib_get_buffers (vm, from, bufs, n_buffers);
 587
 588   si = vnet_get_sw_interface (vnm, sw_if_index);
 589   hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
 590
 591   if (!(si->flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) ||
 592       !(hi->flags & VNET_HW_INTERFACE_FLAG_LINK_UP))
 593     {
 594       vlib_simple_counter_main_t *cm;
 595
 596       cm = vec_elt_at_index (vnm->interface_main.sw_if_counters,
 597                              VNET_INTERFACE_COUNTER_TX_ERROR);
 598       vlib_increment_simple_counter (cm, ti, sw_if_index, n_buffers);
 599
 600       return vlib_error_drop_buffers (
 601         vm, node, from,
 602         /* buffer stride */ 1, n_buffers, VNET_INTERFACE_OUTPUT_NEXT_DROP,
 603         node->node_index, VNET_INTERFACE_OUTPUT_ERROR_INTERFACE_DOWN);
 604     }
 605
 606   if (hi->output_node_thread_runtimes)
 607     r = vec_elt_at_index (hi->output_node_thread_runtimes, vm->thread_index);
 608
 609   if (r)
 610     {
 611       /*
 612        * tx queue of given interface is not available on given thread
 613        */
 614       if (r->n_queues == 0)
 615         return vlib_error_drop_buffers (
 616           vm, node, from,
 617           /* buffer stride */ 1, n_buffers, VNET_INTERFACE_OUTPUT_NEXT_DROP,
 618           node->node_index, VNET_INTERFACE_OUTPUT_ERROR_NO_TX_QUEUE);
 619       /*
 620        * multiple tx queues available on given thread
 621        */
 622       else if (r->n_queues > 1)
 623         /* construct array of pointer */
 624         is_parr = 1;
 625     }
 626
 627   /* interface-output feature arc handling */
 628   if (PREDICT_FALSE (vnet_have_features (arc, sw_if_index)))
 629     {
 630       vnet_feature_config_main_t *fcm;
 631       fcm = vnet_feature_get_config_main (arc);
 632       config_index = vnet_get_feature_config_index (arc, sw_if_index);
 633       vnet_get_config_data (&fcm->config_main, &config_index, &next_index, 0);
 634       arc_or_subif = 1;
 635     }
 636   else if (hash_elts (hi->sub_interface_sw_if_index_by_id))
 637     arc_or_subif = 1;
 638
 639   ccm = im->combined_sw_if_counters + VNET_INTERFACE_COUNTER_TX;
 640
 641   /* if not all three flags IP4_,TCP_,UDP_CKSUM set, do compute them
 642    * here before sending to the interface */
 643   if ((hi->caps & VNET_HW_INTERFACE_CAP_SUPPORTS_TX_CKSUM) !=
 644       VNET_HW_INTERFACE_CAP_SUPPORTS_TX_CKSUM)
 645     do_tx_offloads = 1;
 646
 647   // basic processing
 648   if (do_tx_offloads == 0 && arc_or_subif == 0 && is_parr == 0)
 649     n_bytes = vnet_interface_output_node_inline (
 650       vm, sw_if_index, ccm, bufs, NULL, config_index, arc, n_buffers, 0);
 651   // basic processing + tx offloads
 652   else if (do_tx_offloads == 1 && arc_or_subif == 0 && is_parr == 0)
 653     n_bytes = vnet_interface_output_node_inline (
 654       vm, sw_if_index, ccm, bufs, NULL, config_index, arc, n_buffers, 1);
 655   // basic processing + tx offloads + vlans + arcs
 656   else if (do_tx_offloads == 1 && arc_or_subif == 1 && is_parr == 0)
 657     n_bytes = vnet_interface_output_node_inline (
 658       vm, sw_if_index, ccm, bufs, NULL, config_index, arc, n_buffers, 2);
 659   // basic processing + tx offloads + vlans + arcs + multi-txqs
 660   else
 661     n_bytes = vnet_interface_output_node_inline (
 662       vm, sw_if_index, ccm, bufs, p, config_index, arc, n_buffers, 3);
 663
 664   from = vlib_frame_vector_args (frame);
 665   if (PREDICT_TRUE (next_index == VNET_INTERFACE_OUTPUT_NEXT_TX))
 666     {
 667       enqueue_to_tx_node (vm, node, hi, next_index, r, from, ptr,
 668                           frame->n_vectors);
 669     }
 670   else
 671     {
 672       vlib_buffer_enqueue_to_single_next (vm, node, from, next_index,
 673                                           frame->n_vectors);
 674     }
 675
 676   /* Update main interface stats. */
 677   vlib_increment_combined_counter (ccm, ti, sw_if_index, n_buffers, n_bytes);
 678   return n_buffers;
 679 }
 680
 681 VLIB_REGISTER_NODE (vnet_interface_output_node) = {
 682   .name = "interface-output-template",
 683   .vector_size = sizeof (u32),
 684 };
 685
 686 /* Use buffer's sw_if_index[VNET_TX] to choose output interface. */
 687 VLIB_NODE_FN (vnet_per_buffer_interface_output_node) (vlib_main_t * vm,
 688                                                       vlib_node_runtime_t *
 689                                                       node,
 690                                                       vlib_frame_t * frame)
 691 {
 692   vnet_main_t *vnm = vnet_get_main ();
 693   u32 n_left_to_next, *from, *to_next;
 694   u32 n_left_from, next_index;
 695
 696   vnet_interface_pcap_tx_trace (vm, node, frame, 1 /* in_interface_ouput */);
 697
 698   n_left_from = frame->n_vectors;
 699
 700   from = vlib_frame_vector_args (frame);
 701   next_index = node->cached_next_index;
 702
 703   while (n_left_from > 0)
 704     {
 705       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
 706
 707       while (n_left_from >= 4 && n_left_to_next >= 2)
 708         {
 709           u32 bi0, bi1, next0, next1;
 710           vlib_buffer_t *b0, *b1;
 711           vnet_hw_interface_t *hi0, *hi1;
 712
 713           /* Prefetch next iteration. */
 714           vlib_prefetch_buffer_with_index (vm, from[2], LOAD);
 715           vlib_prefetch_buffer_with_index (vm, from[3], LOAD);
 716
 717           bi0 = from[0];
 718           bi1 = from[1];
 719           to_next[0] = bi0;
 720           to_next[1] = bi1;
 721           from += 2;
 722           to_next += 2;
 723           n_left_to_next -= 2;
 724           n_left_from -= 2;
 725
 726           b0 = vlib_get_buffer (vm, bi0);
 727           b1 = vlib_get_buffer (vm, bi1);
 728
 729           hi0 =
 730             vnet_get_sup_hw_interface (vnm,
 731                                        vnet_buffer (b0)->sw_if_index
 732                                        [VLIB_TX]);
 733           hi1 =
 734             vnet_get_sup_hw_interface (vnm,
 735                                        vnet_buffer (b1)->sw_if_index
 736                                        [VLIB_TX]);
 737
 738           next0 = hi0->output_node_next_index;
 739           next1 = hi1->output_node_next_index;
 740
 741           vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
 742                                            n_left_to_next, bi0, bi1, next0,
 743                                            next1);
 744         }
 745
 746       while (n_left_from > 0 && n_left_to_next > 0)
 747         {
 748           u32 bi0, next0;
 749           vlib_buffer_t *b0;
 750           vnet_hw_interface_t *hi0;
 751
 752           bi0 = from[0];
 753           to_next[0] = bi0;
 754           from += 1;
 755           to_next += 1;
 756           n_left_to_next -= 1;
 757           n_left_from -= 1;
 758
 759           b0 = vlib_get_buffer (vm, bi0);
 760
 761           hi0 =
 762             vnet_get_sup_hw_interface (vnm,
 763                                        vnet_buffer (b0)->sw_if_index
 764                                        [VLIB_TX]);
 765
 766           next0 = hi0->output_node_next_index;
 767
 768           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
 769                                            n_left_to_next, bi0, next0);
 770         }
 771
 772       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
 773     }
 774
 775   return frame->n_vectors;
 776 }
 777
 778 typedef struct vnet_error_trace_t_
 779 {
 780   u32 sw_if_index;
 781   i8 details_valid;
 782   u8 is_ip6;
 783   u8 pad[2];
 784   u16 mactype;
 785   ip46_address_t src, dst;
 786 } vnet_error_trace_t;
 787
 788 static u8 *
 789 format_vnet_error_trace (u8 * s, va_list * va)
 790 {
 791   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
 792   CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *);
 793   vnet_error_trace_t *t = va_arg (*va, vnet_error_trace_t *);
 794
 795   /* Normal, non-catchup trace */
 796   if (t->details_valid == 0)
 797     {
 798       s = format (s, "rx:%U", format_vnet_sw_if_index_name,
 799                   vnet_get_main (), t->sw_if_index);
 800     }
 801   else if (t->details_valid == 1)
 802     {
 803       /* The trace capture code didn't understant the mactype */
 804       s = format (s, "mactype 0x%4x (not decoded)", t->mactype);
 805     }
 806   else if (t->details_valid == 2)
 807     {
 808       /* Dump the src/dst addresses */
 809       if (t->is_ip6 == 0)
 810         s = format (s, "IP4: %U -> %U",
 811                     format_ip4_address, &t->src.ip4,
 812                     format_ip4_address, &t->dst.ip4);
 813       else
 814         s = format (s, "IP6: %U -> %U",
 815                     format_ip6_address, &t->src.ip6,
 816                     format_ip6_address, &t->dst.ip6);
 817     }
 818   return s;
 819 }
 820
 821 static void
 822 interface_trace_buffers (vlib_main_t * vm,
 823                          vlib_node_runtime_t * node, vlib_frame_t * frame)
 824 {
 825   u32 n_left, *buffers;
 826
 827   buffers = vlib_frame_vector_args (frame);
 828   n_left = frame->n_vectors;
 829
 830   while (n_left >= 4)
 831     {
 832       u32 bi0, bi1;
 833       vlib_buffer_t *b0, *b1;
 834       vnet_error_trace_t *t0, *t1;
 835
 836       /* Prefetch next iteration. */
 837       vlib_prefetch_buffer_with_index (vm, buffers[2], LOAD);
 838       vlib_prefetch_buffer_with_index (vm, buffers[3], LOAD);
 839
 840       bi0 = buffers[0];
 841       bi1 = buffers[1];
 842
 843       b0 = vlib_get_buffer (vm, bi0);
 844       b1 = vlib_get_buffer (vm, bi1);
 845
 846       if (b0->flags & VLIB_BUFFER_IS_TRACED)
 847         {
 848           t0 = vlib_add_trace (vm, node, b0,
 849                                STRUCT_OFFSET_OF (vnet_error_trace_t, pad));
 850           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
 851           t0->details_valid = 0;
 852         }
 853       if (b1->flags & VLIB_BUFFER_IS_TRACED)
 854         {
 855           t1 = vlib_add_trace (vm, node, b1,
 856                                STRUCT_OFFSET_OF (vnet_error_trace_t, pad));
 857           t1->sw_if_index = vnet_buffer (b1)->sw_if_index[VLIB_RX];
 858           t1->details_valid = 0;
 859         }
 860       buffers += 2;
 861       n_left -= 2;
 862     }
 863
 864   while (n_left >= 1)
 865     {
 866       u32 bi0;
 867       vlib_buffer_t *b0;
 868       vnet_error_trace_t *t0;
 869
 870       bi0 = buffers[0];
 871
 872       b0 = vlib_get_buffer (vm, bi0);
 873
 874       if (b0->flags & VLIB_BUFFER_IS_TRACED)
 875         {
 876           t0 = vlib_add_trace (vm, node, b0,
 877                                STRUCT_OFFSET_OF (vnet_error_trace_t, pad));
 878           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
 879           t0->details_valid = 0;
 880         }
 881       buffers += 1;
 882       n_left -= 1;
 883     }
 884 }
 885
 886 typedef enum
 887 {
 888   VNET_ERROR_DISPOSITION_DROP,
 889   VNET_ERROR_DISPOSITION_PUNT,
 890   VNET_ERROR_N_DISPOSITION,
 891 } vnet_error_disposition_t;
 892
 893 static void
 894 drop_catchup_trace (vlib_main_t * vm,
 895                     vlib_node_runtime_t * node, vlib_buffer_t * b)
 896 {
 897   /* Can we safely rewind the buffer? If not, fagedaboudit */
 898   if (b->flags & VNET_BUFFER_F_L2_HDR_OFFSET_VALID)
 899     {
 900       vnet_error_trace_t *t;
 901       ip4_header_t *ip4;
 902       ip6_header_t *ip6;
 903       ethernet_header_t *eh;
 904       i16 delta;
 905
 906       t = vlib_add_trace (vm, node, b, sizeof (*t));
 907       delta = vnet_buffer (b)->l2_hdr_offset - b->current_data;
 908       vlib_buffer_advance (b, delta);
 909
 910       eh = vlib_buffer_get_current (b);
 911       /* Save mactype */
 912       t->mactype = clib_net_to_host_u16 (eh->type);
 913       t->details_valid = 1;
 914       switch (t->mactype)
 915         {
 916         case ETHERNET_TYPE_IP4:
 917           ip4 = (void *) (eh + 1);
 918           t->details_valid = 2;
 919           t->is_ip6 = 0;
 920           t->src.ip4.as_u32 = ip4->src_address.as_u32;
 921           t->dst.ip4.as_u32 = ip4->dst_address.as_u32;
 922           break;
 923
 924         case ETHERNET_TYPE_IP6:
 925           ip6 = (void *) (eh + 1);
 926           t->details_valid = 2;
 927           t->is_ip6 = 1;
 928           clib_memcpy_fast (t->src.as_u8, ip6->src_address.as_u8,
 929                             sizeof (ip6_address_t));
 930           clib_memcpy_fast (t->dst.as_u8, ip6->dst_address.as_u8,
 931                             sizeof (ip6_address_t));
 932           break;
 933
 934         default:
 935           /* Dunno, do nothing, leave details_valid alone */
 936           break;
 937         }
 938       /* Restore current data (probably unnecessary) */
 939       vlib_buffer_advance (b, -delta);
 940     }
 941 }
 942
 943 static_always_inline uword
 944 interface_drop_punt (vlib_main_t * vm,
 945                      vlib_node_runtime_t * node,
 946                      vlib_frame_t * frame,
 947                      vnet_error_disposition_t disposition)
 948 {
 949   u32 *from, n_left, thread_index, *sw_if_index;
 950   vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b;
 951   u32 sw_if_indices[VLIB_FRAME_SIZE];
 952   vlib_simple_counter_main_t *cm;
 953   u16 nexts[VLIB_FRAME_SIZE];
 954   u32 n_trace;
 955   vnet_main_t *vnm;
 956
 957   vnm = vnet_get_main ();
 958   thread_index = vm->thread_index;
 959   from = vlib_frame_vector_args (frame);
 960   n_left = frame->n_vectors;
 961   b = bufs;
 962   sw_if_index = sw_if_indices;
 963
 964   vlib_get_buffers (vm, from, bufs, n_left);
 965
 966   /* "trace add error-drop NNN?" */
 967   if (PREDICT_FALSE ((n_trace = vlib_get_trace_count (vm, node))))
 968     {
 969       /* If pkts aren't otherwise traced... */
 970       if ((node->flags & VLIB_NODE_FLAG_TRACE) == 0)
 971         {
 972           /* Trace them from here */
 973           node->flags |= VLIB_NODE_FLAG_TRACE;
 974           while (n_trace && n_left)
 975             {
 976               if (PREDICT_TRUE
 977                   (vlib_trace_buffer (vm, node, 0 /* next_index */ , b[0],
 978                                       0 /* follow chain */ )))
 979                 {
 980                   /*
 981                    * Here we have a wireshark dissector problem.
 982                    * Packets may be well-formed, or not. We
 983                    * must not blow chunks in any case.
 984                    *
 985                    * Try to produce trace records which will help
 986                    * folks understand what's going on.
 987                    */
 988                   drop_catchup_trace (vm, node, b[0]);
 989                   n_trace--;
 990                 }
 991               n_left--;
 992               b++;
 993             }
 994         }
 995
 996       vlib_set_trace_count (vm, node, n_trace);
 997       b = bufs;
 998       n_left = frame->n_vectors;
 999     }
1000
1001   if (node->flags & VLIB_NODE_FLAG_TRACE)
1002     interface_trace_buffers (vm, node, frame);
1003
1004   /* All going to drop regardless, this is just a counting exercise */
1005   clib_memset (nexts, 0, sizeof (nexts));
1006
1007   cm = vec_elt_at_index (vnm->interface_main.sw_if_counters,
1008                          (disposition == VNET_ERROR_DISPOSITION_PUNT
1009                           ? VNET_INTERFACE_COUNTER_PUNT
1010                           : VNET_INTERFACE_COUNTER_DROP));
1011
1012   /* collect the array of interfaces first ... */
1013   while (n_left >= 4)
1014     {
1015       if (n_left >= 12)
1016         {
1017           /* Prefetch 8 ahead - there's not much going on in each iteration */
1018           vlib_prefetch_buffer_header (b[4], LOAD);
1019           vlib_prefetch_buffer_header (b[5], LOAD);
1020           vlib_prefetch_buffer_header (b[6], LOAD);
1021           vlib_prefetch_buffer_header (b[7], LOAD);
1022         }
1023       sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_RX];
1024       sw_if_index[1] = vnet_buffer (b[1])->sw_if_index[VLIB_RX];
1025       sw_if_index[2] = vnet_buffer (b[2])->sw_if_index[VLIB_RX];
1026       sw_if_index[3] = vnet_buffer (b[3])->sw_if_index[VLIB_RX];
1027
1028       sw_if_index += 4;
1029       n_left -= 4;
1030       b += 4;
1031     }
1032   while (n_left)
1033     {
1034       sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_RX];
1035
1036       sw_if_index += 1;
1037       n_left -= 1;
1038       b += 1;
1039     }
1040
1041   /* ... then count against them in blocks */
1042   n_left = frame->n_vectors;
1043
1044   while (n_left)
1045     {
1046       vnet_sw_interface_t *sw_if0;
1047       u16 off, count;
1048
1049       off = frame->n_vectors - n_left;
1050
1051       sw_if_index = sw_if_indices + off;
1052
1053       count = clib_count_equal_u32 (sw_if_index, n_left);
1054       n_left -= count;
1055
1056       vlib_increment_simple_counter (cm, thread_index, sw_if_index[0], count);
1057
1058       /* Increment super-interface drop/punt counters for
1059          sub-interfaces. */
1060       sw_if0 = vnet_get_sw_interface (vnm, sw_if_index[0]);
1061       if (sw_if0->sup_sw_if_index != sw_if_index[0])
1062         vlib_increment_simple_counter
1063           (cm, thread_index, sw_if0->sup_sw_if_index, count);
1064     }
1065
1066   vlib_buffer_enqueue_to_next (vm, node, from, nexts, frame->n_vectors);
1067
1068   return frame->n_vectors;
1069 }
1070
1071 static inline void
1072 pcap_drop_trace (vlib_main_t * vm,
1073                  vnet_interface_main_t * im,
1074                  vnet_pcap_t * pp, vlib_frame_t * f)
1075 {
1076   u32 *from;
1077   u32 n_left = f->n_vectors;
1078   vlib_buffer_t *b0, *p1;
1079   u32 bi0;
1080   i16 save_current_data;
1081   u16 save_current_length;
1082   vlib_error_main_t *em = &vm->error_main;
1083
1084   from = vlib_frame_vector_args (f);
1085
1086   while (n_left > 0)
1087     {
1088       if (PREDICT_TRUE (n_left > 1))
1089         {
1090           p1 = vlib_get_buffer (vm, from[1]);
1091           vlib_prefetch_buffer_header (p1, LOAD);
1092         }
1093
1094       bi0 = from[0];
1095       b0 = vlib_get_buffer (vm, bi0);
1096       from++;
1097       n_left--;
1098
1099       /* See if we're pointedly ignoring this specific error */
1100       if (im->pcap_drop_filter_hash
1101           && hash_get (im->pcap_drop_filter_hash, b0->error))
1102         continue;
1103
1104       if (!vnet_is_packet_pcaped (pp, b0, ~0))
1105         continue; /* not matching, skip */
1106
1107       /* Trace all drops, or drops received on a specific interface */
1108       save_current_data = b0->current_data;
1109       save_current_length = b0->current_length;
1110
1111       /*
1112        * Typically, we'll need to rewind the buffer
1113        * if l2_hdr_offset is valid, make sure to rewind to the start of
1114        * the L2 header. This may not be the buffer start in case we pop-ed
1115        * vlan tags.
1116        * Otherwise, rewind to buffer start and hope for the best.
1117        */
1118       if (b0->flags & VNET_BUFFER_F_L2_HDR_OFFSET_VALID)
1119         {
1120           if (b0->current_data > vnet_buffer (b0)->l2_hdr_offset)
1121             vlib_buffer_advance (b0, vnet_buffer (b0)->l2_hdr_offset -
1122                                        b0->current_data);
1123         }
1124       else if (b0->current_data > 0)
1125         {
1126           vlib_buffer_advance (b0, (word) -b0->current_data);
1127         }
1128
1129       {
1130         vlib_buffer_t *last = b0;
1131         u32 error_node_index;
1132         int drop_string_len;
1133         vlib_node_t *n;
1134         /* Length of the error string */
1135         int error_string_len =
1136           clib_strnlen (em->counters_heap[b0->error].name, 128);
1137
1138         /* Dig up the drop node */
1139         error_node_index = vm->node_main.node_by_error[b0->error];
1140         n = vlib_get_node (vm, error_node_index);
1141
1142         /* Length of full drop string, w/ "nodename: " prepended */
1143         drop_string_len = error_string_len + vec_len (n->name) + 2;
1144
1145         /* Find the last buffer in the chain */
1146         while (last->flags & VLIB_BUFFER_NEXT_PRESENT)
1147           last = vlib_get_buffer (vm, last->next_buffer);
1148
1149         /*
1150          * Append <nodename>: <error-string> to the capture,
1151          * only if we can do that without allocating a new buffer.
1152          */
1153         if (PREDICT_TRUE ((last->current_data + last->current_length) <
1154                           (VLIB_BUFFER_DEFAULT_DATA_SIZE - drop_string_len)))
1155           {
1156             clib_memcpy_fast (last->data + last->current_data +
1157                                 last->current_length,
1158                               n->name, vec_len (n->name));
1159             clib_memcpy_fast (last->data + last->current_data +
1160                                 last->current_length + vec_len (n->name),
1161                               ": ", 2);
1162             clib_memcpy_fast (last->data + last->current_data +
1163                                 last->current_length + vec_len (n->name) + 2,
1164                               em->counters_heap[b0->error].name,
1165                               error_string_len);
1166             last->current_length += drop_string_len;
1167             b0->flags &= ~(VLIB_BUFFER_TOTAL_LENGTH_VALID);
1168             pcap_add_buffer (&pp->pcap_main, vm, bi0, pp->max_bytes_per_pkt);
1169             last->current_length -= drop_string_len;
1170             b0->current_data = save_current_data;
1171             b0->current_length = save_current_length;
1172             continue;
1173           }
1174       }
1175
1176       /*
1177        * Didn't have space in the last buffer, here's the dropped
1178        * packet as-is
1179        */
1180       pcap_add_buffer (&pp->pcap_main, vm, bi0, pp->max_bytes_per_pkt);
1181
1182       b0->current_data = save_current_data;
1183       b0->current_length = save_current_length;
1184     }
1185 }
1186
1187 #ifndef CLIB_MARCH_VARIANT
1188 void
1189 vnet_pcap_drop_trace_filter_add_del (u32 error_index, int is_add)
1190 {
1191   vnet_interface_main_t *im = &vnet_get_main ()->interface_main;
1192
1193   if (im->pcap_drop_filter_hash == 0)
1194     im->pcap_drop_filter_hash = hash_create (0, sizeof (uword));
1195
1196   if (is_add)
1197     hash_set (im->pcap_drop_filter_hash, error_index, 1);
1198   else
1199     hash_unset (im->pcap_drop_filter_hash, error_index);
1200 }
1201 #endif /* CLIB_MARCH_VARIANT */
1202
1203 VLIB_NODE_FN (interface_drop) (vlib_main_t * vm,
1204                                vlib_node_runtime_t * node,
1205                                vlib_frame_t * frame)
1206 {
1207   vnet_main_t *vnm = vnet_get_main ();
1208   vnet_interface_main_t *im = &vnet_get_main ()->interface_main;
1209   vnet_pcap_t *pp = &vnm->pcap;
1210
1211   if (PREDICT_FALSE (pp->pcap_drop_enable))
1212     pcap_drop_trace (vm, im, pp, frame);
1213
1214   return interface_drop_punt (vm, node, frame, VNET_ERROR_DISPOSITION_DROP);
1215 }
1216
1217 VLIB_NODE_FN (interface_punt) (vlib_main_t * vm,
1218                                vlib_node_runtime_t * node,
1219                                vlib_frame_t * frame)
1220 {
1221   return interface_drop_punt (vm, node, frame, VNET_ERROR_DISPOSITION_PUNT);
1222 }
1223
1224 /* *INDENT-OFF* */
1225 VLIB_REGISTER_NODE (interface_drop) = {
1226   .name = "error-drop",
1227   .vector_size = sizeof (u32),
1228   .format_trace = format_vnet_error_trace,
1229   .flags = VLIB_NODE_FLAG_TRACE_SUPPORTED,
1230   .n_next_nodes = 1,
1231   .next_nodes = {
1232     [0] = "drop",
1233   },
1234 };
1235 /* *INDENT-ON* */
1236
1237 /* *INDENT-OFF* */
1238 VLIB_REGISTER_NODE (interface_punt) = {
1239   .name = "error-punt",
1240   .vector_size = sizeof (u32),
1241   .format_trace = format_vnet_error_trace,
1242   .flags = VLIB_NODE_FLAG_TRACE_SUPPORTED,
1243   .n_next_nodes = 1,
1244   .next_nodes = {
1245     [0] = "punt",
1246   },
1247 };
1248 /* *INDENT-ON* */
1249
1250 VLIB_REGISTER_NODE (vnet_per_buffer_interface_output_node) = {
1251   .name = "interface-output",
1252   .vector_size = sizeof (u32),
1253 };
1254
1255 VLIB_NODE_FN (vnet_interface_output_arc_end_node)
1256 (vlib_main_t *vm, vlib_node_runtime_t *node, vlib_frame_t *frame)
1257 {
1258   vnet_main_t *vnm = vnet_get_main ();
1259   vnet_interface_main_t *im = &vnm->interface_main;
1260   vnet_hw_interface_t *hi;
1261   vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b = bufs;
1262   u32 sw_if_indices[VLIB_FRAME_SIZE], *sw_if_index = sw_if_indices;
1263   u64 used_elts[VLIB_FRAME_SIZE / 64] = {};
1264   u64 mask[VLIB_FRAME_SIZE / 64] = {};
1265   u32 *tmp, *from, n_left, n_comp, n_p_comp, swif, off;
1266   u16 next_index;
1267   void *ptr[VLIB_FRAME_SIZE], **p = ptr;
1268
1269   from = vlib_frame_vector_args (frame);
1270   n_left = frame->n_vectors;
1271   vlib_get_buffers (vm, from, bufs, n_left);
1272
1273   while (n_left >= 8)
1274     {
1275       vlib_prefetch_buffer_header (b[4], LOAD);
1276       vlib_prefetch_buffer_header (b[5], LOAD);
1277       vlib_prefetch_buffer_header (b[6], LOAD);
1278       vlib_prefetch_buffer_header (b[7], LOAD);
1279
1280       p[0] = vlib_buffer_get_current (b[0]);
1281       p[1] = vlib_buffer_get_current (b[1]);
1282       p[2] = vlib_buffer_get_current (b[2]);
1283       p[3] = vlib_buffer_get_current (b[3]);
1284       sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
1285       sw_if_index[1] = vnet_buffer (b[1])->sw_if_index[VLIB_TX];
1286       sw_if_index[2] = vnet_buffer (b[2])->sw_if_index[VLIB_TX];
1287       sw_if_index[3] = vnet_buffer (b[3])->sw_if_index[VLIB_TX];
1288
1289       p += 4;
1290       b += 4;
1291       sw_if_index += 4;
1292       n_left -= 4;
1293     }
1294
1295   while (n_left)
1296     {
1297       p[0] = vlib_buffer_get_current (b[0]);
1298       sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
1299       p++;
1300       b++;
1301       sw_if_index++;
1302       n_left--;
1303     }
1304
1305   n_left = frame->n_vectors;
1306   swif = sw_if_indices[0];
1307   off = 0;
1308
1309   /* a bit ugly but it allows us to reuse stack space for temporary store
1310    * which may also improve memory latency */
1311   tmp = (u32 *) bufs;
1312
1313 more:
1314   next_index = vec_elt (im->if_out_arc_end_next_index_by_sw_if_index, swif);
1315   hi = vnet_get_sup_hw_interface (vnm, swif);
1316   vnet_hw_if_output_node_runtime_t *r = 0;
1317   void *ptr_tmp[VLIB_FRAME_SIZE], **p_tmp = ptr_tmp;
1318
1319   if (hi->output_node_thread_runtimes)
1320     r = vec_elt_at_index (hi->output_node_thread_runtimes, vm->thread_index);
1321
1322   /* compare and compress based on comparison mask */
1323   clib_mask_compare_u32 (swif, sw_if_indices, mask, frame->n_vectors);
1324   n_comp = clib_compress_u32 (tmp, from, mask, frame->n_vectors);
1325
1326   /*
1327    * tx queue of given interface is not available on given thread
1328    */
1329   if (r)
1330     {
1331       if (r->n_queues == 0)
1332         {
1333           vlib_error_drop_buffers (
1334             vm, node, tmp,
1335             /* buffer stride */ 1, n_comp, VNET_INTERFACE_OUTPUT_NEXT_DROP,
1336             node->node_index, VNET_INTERFACE_OUTPUT_ERROR_NO_TX_QUEUE);
1337           goto drop;
1338         }
1339       else if (r->n_queues > 1)
1340         {
1341           n_p_comp = clib_compress_u64 ((u64 *) p_tmp, (u64 *) ptr, mask,
1342                                         frame->n_vectors);
1343           ASSERT (n_p_comp == n_comp);
1344         }
1345     }
1346
1347   enqueue_to_tx_node (vm, node, hi, next_index, r, tmp, ptr_tmp, n_comp);
1348
1349 drop:
1350   n_left -= n_comp;
1351   if (n_left)
1352     {
1353       /* store comparison mask so we can find next unused element */
1354       for (int i = 0; i < ARRAY_LEN (used_elts); i++)
1355         used_elts[i] |= mask[i];
1356
1357       /* fine first unused sw_if_index by scanning trough used_elts bitmap */
1358       while (PREDICT_FALSE (used_elts[off] == ~0))
1359         off++;
1360
1361       swif =
1362         sw_if_indices[(off << 6) + count_trailing_zeros (~used_elts[off])];
1363       goto more;
1364     }
1365
1366   return frame->n_vectors;
1367 }
1368
1369 VLIB_REGISTER_NODE (vnet_interface_output_arc_end_node) = {
1370   .name = "interface-output-arc-end",
1371   .vector_size = sizeof (u32),
1372   .n_next_nodes = 1,
1373   .next_nodes = {
1374     [0] = "error-drop",
1375   },
1376 };
1377
1378 VNET_FEATURE_ARC_INIT (interface_output, static) = {
1379   .arc_name = "interface-output",
1380   .start_nodes = VNET_FEATURES (0),
1381   .last_in_arc = "interface-output-arc-end",
1382   .arc_index_ptr = &vnet_main.interface_main.output_feature_arc_index,
1383 };
1384
1385 VNET_FEATURE_INIT (span_tx, static) = {
1386   .arc_name = "interface-output",
1387   .node_name = "span-output",
1388   .runs_before = VNET_FEATURES ("interface-output-arc-end"),
1389 };
1390
1391 VNET_FEATURE_INIT (ipsec_if_tx, static) = {
1392   .arc_name = "interface-output",
1393   .node_name = "ipsec-if-output",
1394   .runs_before = VNET_FEATURES ("interface-output-arc-end"),
1395 };
1396
1397 VNET_FEATURE_INIT (interface_output_arc_end, static) = {
1398   .arc_name = "interface-output",
1399   .node_name = "interface-output-arc-end",
1400   .runs_before = 0,
1401 };
1402
1403 #ifndef CLIB_MARCH_VARIANT
1404 clib_error_t *
1405 vnet_per_buffer_interface_output_hw_interface_add_del (vnet_main_t * vnm,
1406                                                        u32 hw_if_index,
1407                                                        u32 is_create)
1408 {
1409   vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index);
1410   u32 next_index;
1411
1412   if (hi->output_node_index == 0)
1413     return 0;
1414
1415   next_index = vlib_node_add_next
1416     (vnm->vlib_main, vnet_per_buffer_interface_output_node.index,
1417      hi->output_node_index);
1418   hi->output_node_next_index = next_index;
1419
1420   return 0;
1421 }
1422
1423 VNET_HW_INTERFACE_ADD_DEL_FUNCTION
1424   (vnet_per_buffer_interface_output_hw_interface_add_del);
1425
1426 void
1427 vnet_set_interface_output_node (vnet_main_t * vnm,
1428                                 u32 hw_if_index, u32 node_index)
1429 {
1430   ASSERT (node_index);
1431   vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index);
1432   u32 next_index = vlib_node_add_next
1433     (vnm->vlib_main, vnet_per_buffer_interface_output_node.index, node_index);
1434   hi->output_node_next_index = next_index;
1435   hi->output_node_index = node_index;
1436 }
1437 #endif /* CLIB_MARCH_VARIANT */
1438
1439 /*
1440  * fd.io coding-style-patch-verification: ON
1441  *
1442  * Local Variables:
1443  * eval: (c-set-style "gnu")
1444  * End:
1445  */