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/ip/ip4.h>
  43 #include <vnet/ip/ip6.h>
  44 #include <vnet/udp/udp_packet.h>
  45 #include <vnet/feature/feature.h>
  46 #include <vnet/classify/trace_classify.h>
  47
  48 typedef struct
  49 {
  50   u32 sw_if_index;
  51   u32 flags;
  52   u16 gso_size;
  53   u8 gso_l4_hdr_sz;
  54   u8 data[128 - 3 * sizeof (u32)];
  55 }
  56 interface_output_trace_t;
  57
  58 #ifndef CLIB_MARCH_VARIANT
  59 u8 *
  60 format_vnet_interface_output_trace (u8 * s, va_list * va)
  61 {
  62   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
  63   vlib_node_t *node = va_arg (*va, vlib_node_t *);
  64   interface_output_trace_t *t = va_arg (*va, interface_output_trace_t *);
  65   vnet_main_t *vnm = vnet_get_main ();
  66   vnet_sw_interface_t *si;
  67   u32 indent;
  68
  69   if (t->sw_if_index != (u32) ~ 0)
  70     {
  71       indent = format_get_indent (s);
  72
  73       if (pool_is_free_index
  74           (vnm->interface_main.sw_interfaces, t->sw_if_index))
  75         {
  76           /* the interface may have been deleted by the time the trace is printed */
  77           s = format (s, "sw_if_index: %d ", t->sw_if_index);
  78         }
  79       else
  80         {
  81           si = vnet_get_sw_interface (vnm, t->sw_if_index);
  82           s =
  83             format (s, "%U ", format_vnet_sw_interface_name, vnm, si,
  84                     t->flags);
  85         }
  86 #define _(bit, name, v, x) \
  87           if (v && (t->flags & VNET_BUFFER_F_##name)) \
  88             s = format (s, "%s ", v);
  89       foreach_vnet_buffer_flag
  90 #undef _
  91         if (t->flags & VNET_BUFFER_F_GSO)
  92         {
  93           s = format (s, "\n%Ugso_sz %d gso_l4_hdr_sz %d",
  94                       format_white_space, indent + 2, t->gso_size,
  95                       t->gso_l4_hdr_sz);
  96         }
  97       s =
  98         format (s, "\n%U%U", format_white_space, indent,
  99                 node->format_buffer ? node->format_buffer : format_hex_bytes,
 100                 t->data, sizeof (t->data));
 101     }
 102   return s;
 103 }
 104
 105 static void
 106 vnet_interface_output_trace (vlib_main_t * vm,
 107                              vlib_node_runtime_t * node,
 108                              vlib_frame_t * frame, uword n_buffers)
 109 {
 110   u32 n_left, *from;
 111
 112   n_left = n_buffers;
 113   from = vlib_frame_vector_args (frame);
 114
 115   while (n_left >= 4)
 116     {
 117       u32 bi0, bi1;
 118       vlib_buffer_t *b0, *b1;
 119       interface_output_trace_t *t0, *t1;
 120
 121       /* Prefetch next iteration. */
 122       vlib_prefetch_buffer_with_index (vm, from[2], LOAD);
 123       vlib_prefetch_buffer_with_index (vm, from[3], LOAD);
 124
 125       bi0 = from[0];
 126       bi1 = from[1];
 127
 128       b0 = vlib_get_buffer (vm, bi0);
 129       b1 = vlib_get_buffer (vm, bi1);
 130
 131       if (b0->flags & VLIB_BUFFER_IS_TRACED)
 132         {
 133           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
 134           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX];
 135           t0->flags = b0->flags;
 136           t0->gso_size = vnet_buffer2 (b0)->gso_size;
 137           t0->gso_l4_hdr_sz = vnet_buffer2 (b0)->gso_l4_hdr_sz;
 138           clib_memcpy_fast (t0->data, vlib_buffer_get_current (b0),
 139                             sizeof (t0->data));
 140         }
 141       if (b1->flags & VLIB_BUFFER_IS_TRACED)
 142         {
 143           t1 = vlib_add_trace (vm, node, b1, sizeof (t1[0]));
 144           t1->sw_if_index = vnet_buffer (b1)->sw_if_index[VLIB_TX];
 145           t1->flags = b1->flags;
 146           t1->gso_size = vnet_buffer2 (b1)->gso_size;
 147           t1->gso_l4_hdr_sz = vnet_buffer2 (b1)->gso_l4_hdr_sz;
 148           clib_memcpy_fast (t1->data, vlib_buffer_get_current (b1),
 149                             sizeof (t1->data));
 150         }
 151       from += 2;
 152       n_left -= 2;
 153     }
 154
 155   while (n_left >= 1)
 156     {
 157       u32 bi0;
 158       vlib_buffer_t *b0;
 159       interface_output_trace_t *t0;
 160
 161       bi0 = from[0];
 162
 163       b0 = vlib_get_buffer (vm, bi0);
 164
 165       if (b0->flags & VLIB_BUFFER_IS_TRACED)
 166         {
 167           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
 168           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX];
 169           t0->flags = b0->flags;
 170           t0->gso_size = vnet_buffer2 (b0)->gso_size;
 171           t0->gso_l4_hdr_sz = vnet_buffer2 (b0)->gso_l4_hdr_sz;
 172           clib_memcpy_fast (t0->data, vlib_buffer_get_current (b0),
 173                             sizeof (t0->data));
 174         }
 175       from += 1;
 176       n_left -= 1;
 177     }
 178 }
 179
 180 static_always_inline void
 181 calc_checksums (vlib_main_t * vm, vlib_buffer_t * b)
 182 {
 183   tcp_header_t *th;
 184   udp_header_t *uh;
 185
 186   int is_ip4 = (b->flags & VNET_BUFFER_F_IS_IP4) != 0;
 187   int is_ip6 = (b->flags & VNET_BUFFER_F_IS_IP6) != 0;
 188
 189   ASSERT (!(is_ip4 && is_ip6));
 190
 191   th = (tcp_header_t *) (b->data + vnet_buffer (b)->l4_hdr_offset);
 192   uh = (udp_header_t *) (b->data + vnet_buffer (b)->l4_hdr_offset);
 193
 194   if (is_ip4)
 195     {
 196       ip4_header_t *ip4;
 197
 198       ip4 = (ip4_header_t *) (b->data + vnet_buffer (b)->l3_hdr_offset);
 199       if (b->flags & VNET_BUFFER_F_OFFLOAD_IP_CKSUM)
 200         ip4->checksum = ip4_header_checksum (ip4);
 201       if (b->flags & VNET_BUFFER_F_OFFLOAD_TCP_CKSUM)
 202         {
 203           th->checksum = 0;
 204           th->checksum = ip4_tcp_udp_compute_checksum (vm, b, ip4);
 205         }
 206       else if (b->flags & VNET_BUFFER_F_OFFLOAD_UDP_CKSUM)
 207         uh->checksum = ip4_tcp_udp_compute_checksum (vm, b, ip4);
 208     }
 209   else if (is_ip6)
 210     {
 211       int bogus;
 212       ip6_header_t *ip6;
 213
 214       ip6 = (ip6_header_t *) (b->data + vnet_buffer (b)->l3_hdr_offset);
 215       if (b->flags & VNET_BUFFER_F_OFFLOAD_TCP_CKSUM)
 216         {
 217           th->checksum = 0;
 218           th->checksum =
 219             ip6_tcp_udp_icmp_compute_checksum (vm, b, ip6, &bogus);
 220         }
 221       else if (b->flags & VNET_BUFFER_F_OFFLOAD_UDP_CKSUM)
 222         {
 223           uh->checksum = 0;
 224           uh->checksum =
 225             ip6_tcp_udp_icmp_compute_checksum (vm, b, ip6, &bogus);
 226         }
 227     }
 228   b->flags &= ~VNET_BUFFER_F_OFFLOAD_TCP_CKSUM;
 229   b->flags &= ~VNET_BUFFER_F_OFFLOAD_UDP_CKSUM;
 230   b->flags &= ~VNET_BUFFER_F_OFFLOAD_IP_CKSUM;
 231 }
 232
 233 static_always_inline u16
 234 tso_alloc_tx_bufs (vlib_main_t * vm,
 235                    vnet_interface_per_thread_data_t * ptd,
 236                    vlib_buffer_t * b0, u32 n_bytes_b0, u16 l234_sz,
 237                    u16 gso_size)
 238 {
 239   u16 size =
 240     clib_min (gso_size, vlib_buffer_get_default_data_size (vm) - l234_sz);
 241
 242   /* rounded-up division */
 243   u16 n_bufs = (n_bytes_b0 - l234_sz + (size - 1)) / size;
 244   u16 n_alloc;
 245
 246   ASSERT (n_bufs > 0);
 247   vec_validate (ptd->split_buffers, n_bufs - 1);
 248
 249   n_alloc = vlib_buffer_alloc (vm, ptd->split_buffers, n_bufs);
 250   if (n_alloc < n_bufs)
 251     {
 252       vlib_buffer_free (vm, ptd->split_buffers, n_alloc);
 253       return 0;
 254     }
 255   return n_alloc;
 256 }
 257
 258 static_always_inline void
 259 tso_init_buf_from_template_base (vlib_buffer_t * nb0, vlib_buffer_t * b0,
 260                                  u32 flags, u16 length)
 261 {
 262   nb0->current_data = b0->current_data;
 263   nb0->total_length_not_including_first_buffer = 0;
 264   nb0->flags = VLIB_BUFFER_TOTAL_LENGTH_VALID | flags;
 265   clib_memcpy_fast (&nb0->opaque, &b0->opaque, sizeof (nb0->opaque));
 266   clib_memcpy_fast (vlib_buffer_get_current (nb0),
 267                     vlib_buffer_get_current (b0), length);
 268   nb0->current_length = length;
 269 }
 270
 271 static_always_inline void
 272 tso_init_buf_from_template (vlib_main_t * vm, vlib_buffer_t * nb0,
 273                             vlib_buffer_t * b0, u16 template_data_sz,
 274                             u16 gso_size, u8 ** p_dst_ptr, u16 * p_dst_left,
 275                             u32 next_tcp_seq, u32 flags)
 276 {
 277   tso_init_buf_from_template_base (nb0, b0, flags, template_data_sz);
 278
 279   *p_dst_left =
 280     clib_min (gso_size,
 281               vlib_buffer_get_default_data_size (vm) - (template_data_sz +
 282                                                         nb0->current_data));
 283   *p_dst_ptr = vlib_buffer_get_current (nb0) + template_data_sz;
 284
 285   tcp_header_t *tcp =
 286     (tcp_header_t *) (nb0->data + vnet_buffer (nb0)->l4_hdr_offset);
 287   tcp->seq_number = clib_host_to_net_u32 (next_tcp_seq);
 288 }
 289
 290 static_always_inline void
 291 tso_fixup_segmented_buf (vlib_buffer_t * b0, u8 tcp_flags, int is_ip6)
 292 {
 293   u16 l3_hdr_offset = vnet_buffer (b0)->l3_hdr_offset;
 294   u16 l4_hdr_offset = vnet_buffer (b0)->l4_hdr_offset;
 295   ip4_header_t *ip4 = (ip4_header_t *) (b0->data + l3_hdr_offset);
 296   ip6_header_t *ip6 = (ip6_header_t *) (b0->data + l3_hdr_offset);
 297   tcp_header_t *tcp = (tcp_header_t *) (b0->data + l4_hdr_offset);
 298
 299   tcp->flags = tcp_flags;
 300
 301   if (is_ip6)
 302     ip6->payload_length =
 303       clib_host_to_net_u16 (b0->current_length -
 304                             (l4_hdr_offset - b0->current_data));
 305   else
 306     ip4->length =
 307       clib_host_to_net_u16 (b0->current_length -
 308                             (l3_hdr_offset - b0->current_data));
 309 }
 310
 311 /**
 312  * Allocate the necessary number of ptd->split_buffers,
 313  * and segment the possibly chained buffer(s) from b0 into
 314  * there.
 315  *
 316  * Return the cumulative number of bytes sent or zero
 317  * if allocation failed.
 318  */
 319
 320 static_always_inline u32
 321 tso_segment_buffer (vlib_main_t * vm, vnet_interface_per_thread_data_t * ptd,
 322                     int do_tx_offloads, u32 sbi0, vlib_buffer_t * sb0,
 323                     u32 n_bytes_b0)
 324 {
 325   u32 n_tx_bytes = 0;
 326   int is_ip4 = sb0->flags & VNET_BUFFER_F_IS_IP4;
 327   int is_ip6 = sb0->flags & VNET_BUFFER_F_IS_IP6;
 328   ASSERT (is_ip4 || is_ip6);
 329   ASSERT (sb0->flags & VNET_BUFFER_F_L2_HDR_OFFSET_VALID);
 330   ASSERT (sb0->flags & VNET_BUFFER_F_L3_HDR_OFFSET_VALID);
 331   ASSERT (sb0->flags & VNET_BUFFER_F_L4_HDR_OFFSET_VALID);
 332   u16 gso_size = vnet_buffer2 (sb0)->gso_size;
 333
 334   int l4_hdr_sz = vnet_buffer2 (sb0)->gso_l4_hdr_sz;
 335   u8 save_tcp_flags = 0;
 336   u8 tcp_flags_no_fin_psh = 0;
 337   u32 next_tcp_seq = 0;
 338
 339   tcp_header_t *tcp =
 340     (tcp_header_t *) (sb0->data + vnet_buffer (sb0)->l4_hdr_offset);
 341   next_tcp_seq = clib_net_to_host_u32 (tcp->seq_number);
 342   /* store original flags for last packet and reset FIN and PSH */
 343   save_tcp_flags = tcp->flags;
 344   tcp_flags_no_fin_psh = tcp->flags & ~(TCP_FLAG_FIN | TCP_FLAG_PSH);
 345   tcp->checksum = 0;
 346
 347   u32 default_bflags =
 348     sb0->flags & ~(VNET_BUFFER_F_GSO | VLIB_BUFFER_NEXT_PRESENT);
 349   u16 l234_sz = vnet_buffer (sb0)->l4_hdr_offset + l4_hdr_sz
 350     - sb0->current_data;
 351   int first_data_size = clib_min (gso_size, sb0->current_length - l234_sz);
 352   next_tcp_seq += first_data_size;
 353
 354   if (PREDICT_FALSE
 355       (!tso_alloc_tx_bufs (vm, ptd, sb0, n_bytes_b0, l234_sz, gso_size)))
 356     return 0;
 357
 358   vlib_buffer_t *b0 = vlib_get_buffer (vm, ptd->split_buffers[0]);
 359   tso_init_buf_from_template_base (b0, sb0, default_bflags,
 360                                    l234_sz + first_data_size);
 361
 362   u32 total_src_left = n_bytes_b0 - l234_sz - first_data_size;
 363   if (total_src_left)
 364     {
 365       /* Need to copy more segments */
 366       u8 *src_ptr, *dst_ptr;
 367       u16 src_left, dst_left;
 368       /* current source buffer */
 369       vlib_buffer_t *csb0 = sb0;
 370       u32 csbi0 = sbi0;
 371       /* current dest buffer */
 372       vlib_buffer_t *cdb0;
 373       u16 dbi = 1;              /* the buffer [0] is b0 */
 374
 375       src_ptr = vlib_buffer_get_current (sb0) + l234_sz + first_data_size;
 376       src_left = sb0->current_length - l234_sz - first_data_size;
 377
 378       tso_fixup_segmented_buf (b0, tcp_flags_no_fin_psh, is_ip6);
 379       if (do_tx_offloads)
 380         calc_checksums (vm, b0);
 381
 382       /* grab a second buffer and prepare the loop */
 383       ASSERT (dbi < vec_len (ptd->split_buffers));
 384       cdb0 = vlib_get_buffer (vm, ptd->split_buffers[dbi++]);
 385       tso_init_buf_from_template (vm, cdb0, b0, l234_sz, gso_size, &dst_ptr,
 386                                   &dst_left, next_tcp_seq, default_bflags);
 387
 388       /* an arbitrary large number to catch the runaway loops */
 389       int nloops = 2000;
 390       while (total_src_left)
 391         {
 392           if (nloops-- <= 0)
 393             clib_panic ("infinite loop detected");
 394           u16 bytes_to_copy = clib_min (src_left, dst_left);
 395
 396           clib_memcpy_fast (dst_ptr, src_ptr, bytes_to_copy);
 397
 398           src_left -= bytes_to_copy;
 399           src_ptr += bytes_to_copy;
 400           total_src_left -= bytes_to_copy;
 401           dst_left -= bytes_to_copy;
 402           dst_ptr += bytes_to_copy;
 403           next_tcp_seq += bytes_to_copy;
 404           cdb0->current_length += bytes_to_copy;
 405
 406           if (0 == src_left)
 407             {
 408               int has_next = (csb0->flags & VLIB_BUFFER_NEXT_PRESENT);
 409               u32 next_bi = csb0->next_buffer;
 410
 411               /* init src to the next buffer in chain */
 412               if (has_next)
 413                 {
 414                   csbi0 = next_bi;
 415                   csb0 = vlib_get_buffer (vm, csbi0);
 416                   src_left = csb0->current_length;
 417                   src_ptr = vlib_buffer_get_current (csb0);
 418                 }
 419               else
 420                 {
 421                   ASSERT (total_src_left == 0);
 422                   break;
 423                 }
 424             }
 425           if (0 == dst_left && total_src_left)
 426             {
 427               if (do_tx_offloads)
 428                 calc_checksums (vm, cdb0);
 429               n_tx_bytes += cdb0->current_length;
 430               ASSERT (dbi < vec_len (ptd->split_buffers));
 431               cdb0 = vlib_get_buffer (vm, ptd->split_buffers[dbi++]);
 432               tso_init_buf_from_template (vm, cdb0, b0, l234_sz,
 433                                           gso_size, &dst_ptr, &dst_left,
 434                                           next_tcp_seq, default_bflags);
 435             }
 436         }
 437
 438       tso_fixup_segmented_buf (cdb0, save_tcp_flags, is_ip6);
 439       if (do_tx_offloads)
 440         calc_checksums (vm, cdb0);
 441
 442       n_tx_bytes += cdb0->current_length;
 443     }
 444   n_tx_bytes += b0->current_length;
 445   return n_tx_bytes;
 446 }
 447
 448 static_always_inline void
 449 drop_one_buffer_and_count (vlib_main_t * vm, vnet_main_t * vnm,
 450                            vlib_node_runtime_t * node, u32 * pbi0,
 451                            u32 drop_error_code)
 452 {
 453   u32 thread_index = vm->thread_index;
 454   vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
 455
 456   vlib_simple_counter_main_t *cm;
 457   cm =
 458     vec_elt_at_index (vnm->interface_main.sw_if_counters,
 459                       VNET_INTERFACE_COUNTER_TX_ERROR);
 460   vlib_increment_simple_counter (cm, thread_index, rt->sw_if_index, 1);
 461
 462   vlib_error_drop_buffers (vm, node, pbi0,
 463                            /* buffer stride */ 1,
 464                            /* n_buffers */ 1,
 465                            VNET_INTERFACE_OUTPUT_NEXT_DROP,
 466                            node->node_index, drop_error_code);
 467 }
 468
 469 static_always_inline uword
 470 vnet_interface_output_node_inline_gso (vlib_main_t * vm,
 471                                        vlib_node_runtime_t * node,
 472                                        vlib_frame_t * frame,
 473                                        vnet_main_t * vnm,
 474                                        vnet_hw_interface_t * hi,
 475                                        int do_tx_offloads,
 476                                        int do_segmentation)
 477 {
 478   vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
 479   vnet_sw_interface_t *si;
 480   u32 n_left_to_tx, *from, *from_end, *to_tx;
 481   u32 n_bytes, n_buffers, n_packets;
 482   u32 n_bytes_b0, n_bytes_b1, n_bytes_b2, n_bytes_b3;
 483   u32 thread_index = vm->thread_index;
 484   vnet_interface_main_t *im = &vnm->interface_main;
 485   u32 next_index = VNET_INTERFACE_OUTPUT_NEXT_TX;
 486   u32 current_config_index = ~0;
 487   u8 arc = im->output_feature_arc_index;
 488   vnet_interface_per_thread_data_t *ptd =
 489     vec_elt_at_index (im->per_thread_data, thread_index);
 490   vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b = bufs;
 491
 492   n_buffers = frame->n_vectors;
 493
 494   if (node->flags & VLIB_NODE_FLAG_TRACE)
 495     vnet_interface_output_trace (vm, node, frame, n_buffers);
 496
 497   from = vlib_frame_vector_args (frame);
 498   vlib_get_buffers (vm, from, b, n_buffers);
 499
 500   if (rt->is_deleted)
 501     return vlib_error_drop_buffers (vm, node, from,
 502                                     /* buffer stride */ 1,
 503                                     n_buffers,
 504                                     VNET_INTERFACE_OUTPUT_NEXT_DROP,
 505                                     node->node_index,
 506                                     VNET_INTERFACE_OUTPUT_ERROR_INTERFACE_DELETED);
 507
 508   si = vnet_get_sw_interface (vnm, rt->sw_if_index);
 509   hi = vnet_get_sup_hw_interface (vnm, rt->sw_if_index);
 510   if (!(si->flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) ||
 511       !(hi->flags & VNET_HW_INTERFACE_FLAG_LINK_UP))
 512     {
 513       vlib_simple_counter_main_t *cm;
 514
 515       cm = vec_elt_at_index (vnm->interface_main.sw_if_counters,
 516                              VNET_INTERFACE_COUNTER_TX_ERROR);
 517       vlib_increment_simple_counter (cm, thread_index,
 518                                      rt->sw_if_index, n_buffers);
 519
 520       return vlib_error_drop_buffers (vm, node, from,
 521                                       /* buffer stride */ 1,
 522                                       n_buffers,
 523                                       VNET_INTERFACE_OUTPUT_NEXT_DROP,
 524                                       node->node_index,
 525                                       VNET_INTERFACE_OUTPUT_ERROR_INTERFACE_DOWN);
 526     }
 527
 528   from_end = from + n_buffers;
 529
 530   /* Total byte count of all buffers. */
 531   n_bytes = 0;
 532   n_packets = 0;
 533
 534   /* interface-output feature arc handling */
 535   if (PREDICT_FALSE (vnet_have_features (arc, rt->sw_if_index)))
 536     {
 537       vnet_feature_config_main_t *fcm;
 538       fcm = vnet_feature_get_config_main (arc);
 539       current_config_index = vnet_get_feature_config_index (arc,
 540                                                             rt->sw_if_index);
 541       vnet_get_config_data (&fcm->config_main, &current_config_index,
 542                             &next_index, 0);
 543     }
 544
 545   while (from < from_end)
 546     {
 547       /* Get new next frame since previous incomplete frame may have less
 548          than VNET_FRAME_SIZE vectors in it. */
 549       vlib_get_new_next_frame (vm, node, next_index, to_tx, n_left_to_tx);
 550
 551       while (from + 8 <= from_end && n_left_to_tx >= 4)
 552         {
 553           u32 bi0, bi1, bi2, bi3;
 554           u32 tx_swif0, tx_swif1, tx_swif2, tx_swif3;
 555           u32 or_flags;
 556
 557           /* Prefetch next iteration. */
 558           vlib_prefetch_buffer_header (b[4], LOAD);
 559           vlib_prefetch_buffer_header (b[5], LOAD);
 560           vlib_prefetch_buffer_header (b[6], LOAD);
 561           vlib_prefetch_buffer_header (b[7], LOAD);
 562
 563           bi0 = from[0];
 564           bi1 = from[1];
 565           bi2 = from[2];
 566           bi3 = from[3];
 567           to_tx[0] = bi0;
 568           to_tx[1] = bi1;
 569           to_tx[2] = bi2;
 570           to_tx[3] = bi3;
 571
 572           or_flags = b[0]->flags | b[1]->flags | b[2]->flags | b[3]->flags;
 573
 574           if (do_segmentation)
 575             {
 576               /* go to single loop if we need TSO segmentation */
 577               if (PREDICT_FALSE (or_flags & VNET_BUFFER_F_GSO))
 578                 break;
 579             }
 580           from += 4;
 581           to_tx += 4;
 582           n_left_to_tx -= 4;
 583
 584           /* Be grumpy about zero length buffers for benefit of
 585              driver tx function. */
 586           ASSERT (b[0]->current_length > 0);
 587           ASSERT (b[1]->current_length > 0);
 588           ASSERT (b[2]->current_length > 0);
 589           ASSERT (b[3]->current_length > 0);
 590
 591           n_bytes_b0 = vlib_buffer_length_in_chain (vm, b[0]);
 592           n_bytes_b1 = vlib_buffer_length_in_chain (vm, b[1]);
 593           n_bytes_b2 = vlib_buffer_length_in_chain (vm, b[2]);
 594           n_bytes_b3 = vlib_buffer_length_in_chain (vm, b[3]);
 595           tx_swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
 596           tx_swif1 = vnet_buffer (b[1])->sw_if_index[VLIB_TX];
 597           tx_swif2 = vnet_buffer (b[2])->sw_if_index[VLIB_TX];
 598           tx_swif3 = vnet_buffer (b[3])->sw_if_index[VLIB_TX];
 599
 600           n_bytes += n_bytes_b0 + n_bytes_b1;
 601           n_bytes += n_bytes_b2 + n_bytes_b3;
 602           n_packets += 4;
 603
 604           if (PREDICT_FALSE (current_config_index != ~0))
 605             {
 606               vnet_buffer (b[0])->feature_arc_index = arc;
 607               vnet_buffer (b[1])->feature_arc_index = arc;
 608               vnet_buffer (b[2])->feature_arc_index = arc;
 609               vnet_buffer (b[3])->feature_arc_index = arc;
 610               b[0]->current_config_index = current_config_index;
 611               b[1]->current_config_index = current_config_index;
 612               b[2]->current_config_index = current_config_index;
 613               b[3]->current_config_index = current_config_index;
 614             }
 615
 616           /* update vlan subif tx counts, if required */
 617           if (PREDICT_FALSE (tx_swif0 != rt->sw_if_index))
 618             {
 619               vlib_increment_combined_counter (im->combined_sw_if_counters +
 620                                                VNET_INTERFACE_COUNTER_TX,
 621                                                thread_index, tx_swif0, 1,
 622                                                n_bytes_b0);
 623             }
 624
 625           if (PREDICT_FALSE (tx_swif1 != rt->sw_if_index))
 626             {
 627
 628               vlib_increment_combined_counter (im->combined_sw_if_counters +
 629                                                VNET_INTERFACE_COUNTER_TX,
 630                                                thread_index, tx_swif1, 1,
 631                                                n_bytes_b1);
 632             }
 633
 634           if (PREDICT_FALSE (tx_swif2 != rt->sw_if_index))
 635             {
 636
 637               vlib_increment_combined_counter (im->combined_sw_if_counters +
 638                                                VNET_INTERFACE_COUNTER_TX,
 639                                                thread_index, tx_swif2, 1,
 640                                                n_bytes_b2);
 641             }
 642           if (PREDICT_FALSE (tx_swif3 != rt->sw_if_index))
 643             {
 644
 645               vlib_increment_combined_counter (im->combined_sw_if_counters +
 646                                                VNET_INTERFACE_COUNTER_TX,
 647                                                thread_index, tx_swif3, 1,
 648                                                n_bytes_b3);
 649             }
 650
 651           if (do_tx_offloads)
 652             {
 653               if (or_flags &
 654                   (VNET_BUFFER_F_OFFLOAD_TCP_CKSUM |
 655                    VNET_BUFFER_F_OFFLOAD_UDP_CKSUM |
 656                    VNET_BUFFER_F_OFFLOAD_IP_CKSUM))
 657                 {
 658                   calc_checksums (vm, b[0]);
 659                   calc_checksums (vm, b[1]);
 660                   calc_checksums (vm, b[2]);
 661                   calc_checksums (vm, b[3]);
 662                 }
 663             }
 664           b += 4;
 665
 666         }
 667
 668       while (from + 1 <= from_end && n_left_to_tx >= 1)
 669         {
 670           u32 bi0;
 671           u32 tx_swif0;
 672
 673           bi0 = from[0];
 674           to_tx[0] = bi0;
 675           from += 1;
 676           to_tx += 1;
 677           n_left_to_tx -= 1;
 678
 679           /* Be grumpy about zero length buffers for benefit of
 680              driver tx function. */
 681           ASSERT (b[0]->current_length > 0);
 682
 683           n_bytes_b0 = vlib_buffer_length_in_chain (vm, b[0]);
 684           tx_swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
 685           n_bytes += n_bytes_b0;
 686           n_packets += 1;
 687
 688           if (PREDICT_FALSE (current_config_index != ~0))
 689             {
 690               vnet_buffer (b[0])->feature_arc_index = arc;
 691               b[0]->current_config_index = current_config_index;
 692             }
 693
 694           if (do_segmentation)
 695             {
 696               if (PREDICT_FALSE (b[0]->flags & VNET_BUFFER_F_GSO))
 697                 {
 698                   /*
 699                    * Undo the enqueue of the b0 - it is not going anywhere,
 700                    * and will be freed either after it's segmented or
 701                    * when dropped, if there is no buffers to segment into.
 702                    */
 703                   to_tx -= 1;
 704                   n_left_to_tx += 1;
 705                   /* undo the counting. */
 706                   n_bytes -= n_bytes_b0;
 707                   n_packets -= 1;
 708
 709                   u32 n_tx_bytes = 0;
 710
 711                   n_tx_bytes =
 712                     tso_segment_buffer (vm, ptd, do_tx_offloads, bi0, b[0],
 713                                         n_bytes_b0);
 714
 715                   if (PREDICT_FALSE (n_tx_bytes == 0))
 716                     {
 717                       drop_one_buffer_and_count (vm, vnm, node, from - 1,
 718                                                  VNET_INTERFACE_OUTPUT_ERROR_NO_BUFFERS_FOR_GSO);
 719                       b += 1;
 720                       continue;
 721                     }
 722
 723                   u16 n_tx_bufs = vec_len (ptd->split_buffers);
 724                   u32 *from_tx_seg = ptd->split_buffers;
 725
 726                   while (n_tx_bufs > 0)
 727                     {
 728                       if (n_tx_bufs >= n_left_to_tx)
 729                         {
 730                           while (n_left_to_tx > 0)
 731                             {
 732                               to_tx[0] = from_tx_seg[0];
 733                               to_tx += 1;
 734                               from_tx_seg += 1;
 735                               n_left_to_tx -= 1;
 736                               n_tx_bufs -= 1;
 737                               n_packets += 1;
 738                             }
 739                           vlib_put_next_frame (vm, node, next_index,
 740                                                n_left_to_tx);
 741                           vlib_get_new_next_frame (vm, node, next_index,
 742                                                    to_tx, n_left_to_tx);
 743                         }
 744                       while (n_tx_bufs > 0)
 745                         {
 746                           to_tx[0] = from_tx_seg[0];
 747                           to_tx += 1;
 748                           from_tx_seg += 1;
 749                           n_left_to_tx -= 1;
 750                           n_tx_bufs -= 1;
 751                           n_packets += 1;
 752                         }
 753                     }
 754                   n_bytes += n_tx_bytes;
 755                   if (PREDICT_FALSE (tx_swif0 != rt->sw_if_index))
 756                     {
 757
 758                       vlib_increment_combined_counter
 759                         (im->combined_sw_if_counters +
 760                          VNET_INTERFACE_COUNTER_TX, thread_index, tx_swif0,
 761                          _vec_len (ptd->split_buffers), n_tx_bytes);
 762                     }
 763                   /* The buffers were enqueued. Reset the length */
 764                   _vec_len (ptd->split_buffers) = 0;
 765                   /* Free the now segmented buffer */
 766                   vlib_buffer_free_one (vm, bi0);
 767                   b += 1;
 768                   continue;
 769                 }
 770             }
 771
 772           if (PREDICT_FALSE (tx_swif0 != rt->sw_if_index))
 773             {
 774
 775               vlib_increment_combined_counter (im->combined_sw_if_counters +
 776                                                VNET_INTERFACE_COUNTER_TX,
 777                                                thread_index, tx_swif0, 1,
 778                                                n_bytes_b0);
 779             }
 780
 781           if (do_tx_offloads)
 782             calc_checksums (vm, b[0]);
 783
 784           b += 1;
 785         }
 786
 787       vlib_put_next_frame (vm, node, next_index, n_left_to_tx);
 788     }
 789
 790   /* Update main interface stats. */
 791   vlib_increment_combined_counter (im->combined_sw_if_counters
 792                                    + VNET_INTERFACE_COUNTER_TX,
 793                                    thread_index,
 794                                    rt->sw_if_index, n_packets, n_bytes);
 795   return n_buffers;
 796 }
 797 #endif /* CLIB_MARCH_VARIANT */
 798
 799 static_always_inline void vnet_interface_pcap_tx_trace
 800   (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame,
 801    int sw_if_index_from_buffer)
 802 {
 803   u32 n_left_from, *from;
 804   u32 sw_if_index;
 805
 806   if (PREDICT_TRUE (vlib_global_main.pcap[VLIB_TX].pcap_enable == 0))
 807     return;
 808
 809   if (sw_if_index_from_buffer == 0)
 810     {
 811       vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
 812       sw_if_index = rt->sw_if_index;
 813     }
 814   else
 815     sw_if_index = ~0;
 816
 817   vnet_main_t *vnm = vnet_get_main ();
 818   n_left_from = frame->n_vectors;
 819   from = vlib_frame_vector_args (frame);
 820
 821   while (n_left_from > 0)
 822     {
 823       int classify_filter_result;
 824       u32 bi0 = from[0];
 825       vlib_buffer_t *b0 = vlib_get_buffer (vm, bi0);
 826       from++;
 827       n_left_from--;
 828
 829       if (vec_len (vnm->classify_filter_table_indices))
 830         {
 831           classify_filter_result =
 832             vnet_is_packet_traced_inline
 833             (b0, vnm->classify_filter_table_indices[0],
 834              0 /* full classify */ );
 835           if (classify_filter_result)
 836             pcap_add_buffer (&vlib_global_main.pcap[VLIB_TX].pcap_main, vm,
 837                              bi0, 512);
 838           continue;
 839         }
 840
 841       if (sw_if_index_from_buffer)
 842         sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_TX];
 843
 844       if (vlib_global_main.pcap[VLIB_TX].pcap_sw_if_index == 0 ||
 845           vlib_global_main.pcap[VLIB_TX].pcap_sw_if_index == sw_if_index)
 846         pcap_add_buffer (&vlib_global_main.pcap[VLIB_TX].pcap_main, vm, bi0,
 847                          512);
 848     }
 849 }
 850
 851 #ifndef CLIB_MARCH_VARIANT
 852 static_always_inline uword
 853 vnet_interface_output_node_inline (vlib_main_t * vm,
 854                                    vlib_node_runtime_t * node,
 855                                    vlib_frame_t * frame, vnet_main_t * vnm,
 856                                    vnet_hw_interface_t * hi,
 857                                    int do_tx_offloads)
 858 {
 859   /*
 860    * The 3-headed "if" is here because we want to err on the side
 861    * of not impacting the non-GSO performance - so for the more
 862    * common case of no GSO interfaces we want to prevent the
 863    * segmentation codepath from being there altogether.
 864    */
 865   if (PREDICT_TRUE (vnm->interface_main.gso_interface_count == 0))
 866     return vnet_interface_output_node_inline_gso (vm, node, frame, vnm, hi,
 867                                                   do_tx_offloads,
 868                                                   /* do_segmentation */ 0);
 869   else if (hi->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO)
 870     return vnet_interface_output_node_inline_gso (vm, node, frame, vnm, hi,
 871                                                   do_tx_offloads,
 872                                                   /* do_segmentation */ 0);
 873   else
 874     return vnet_interface_output_node_inline_gso (vm, node, frame, vnm, hi,
 875                                                   do_tx_offloads,
 876                                                   /* do_segmentation */ 1);
 877 }
 878
 879 uword
 880 vnet_interface_output_node (vlib_main_t * vm, vlib_node_runtime_t * node,
 881                             vlib_frame_t * frame)
 882 {
 883   vnet_main_t *vnm = vnet_get_main ();
 884   vnet_hw_interface_t *hi;
 885   vnet_interface_output_runtime_t *rt = (void *) node->runtime_data;
 886   hi = vnet_get_sup_hw_interface (vnm, rt->sw_if_index);
 887
 888   vnet_interface_pcap_tx_trace (vm, node, frame,
 889                                 0 /* sw_if_index_from_buffer */ );
 890
 891   if (hi->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_TX_L4_CKSUM_OFFLOAD)
 892     return vnet_interface_output_node_inline (vm, node, frame, vnm, hi,
 893                                               /* do_tx_offloads */ 0);
 894   else
 895     return vnet_interface_output_node_inline (vm, node, frame, vnm, hi,
 896                                               /* do_tx_offloads */ 1);
 897 }
 898 #endif /* CLIB_MARCH_VARIANT */
 899
 900 /* Use buffer's sw_if_index[VNET_TX] to choose output interface. */
 901 VLIB_NODE_FN (vnet_per_buffer_interface_output_node) (vlib_main_t * vm,
 902                                                       vlib_node_runtime_t *
 903                                                       node,
 904                                                       vlib_frame_t * frame)
 905 {
 906   vnet_main_t *vnm = vnet_get_main ();
 907   u32 n_left_to_next, *from, *to_next;
 908   u32 n_left_from, next_index;
 909
 910   vnet_interface_pcap_tx_trace (vm, node, frame,
 911                                 1 /* sw_if_index_from_buffer */ );
 912
 913   n_left_from = frame->n_vectors;
 914
 915   from = vlib_frame_vector_args (frame);
 916   next_index = node->cached_next_index;
 917
 918   while (n_left_from > 0)
 919     {
 920       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
 921
 922       while (n_left_from >= 4 && n_left_to_next >= 2)
 923         {
 924           u32 bi0, bi1, next0, next1;
 925           vlib_buffer_t *b0, *b1;
 926           vnet_hw_interface_t *hi0, *hi1;
 927
 928           /* Prefetch next iteration. */
 929           vlib_prefetch_buffer_with_index (vm, from[2], LOAD);
 930           vlib_prefetch_buffer_with_index (vm, from[3], LOAD);
 931
 932           bi0 = from[0];
 933           bi1 = from[1];
 934           to_next[0] = bi0;
 935           to_next[1] = bi1;
 936           from += 2;
 937           to_next += 2;
 938           n_left_to_next -= 2;
 939           n_left_from -= 2;
 940
 941           b0 = vlib_get_buffer (vm, bi0);
 942           b1 = vlib_get_buffer (vm, bi1);
 943
 944           hi0 =
 945             vnet_get_sup_hw_interface (vnm,
 946                                        vnet_buffer (b0)->sw_if_index
 947                                        [VLIB_TX]);
 948           hi1 =
 949             vnet_get_sup_hw_interface (vnm,
 950                                        vnet_buffer (b1)->sw_if_index
 951                                        [VLIB_TX]);
 952
 953           next0 = hi0->output_node_next_index;
 954           next1 = hi1->output_node_next_index;
 955
 956           vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
 957                                            n_left_to_next, bi0, bi1, next0,
 958                                            next1);
 959         }
 960
 961       while (n_left_from > 0 && n_left_to_next > 0)
 962         {
 963           u32 bi0, next0;
 964           vlib_buffer_t *b0;
 965           vnet_hw_interface_t *hi0;
 966
 967           bi0 = from[0];
 968           to_next[0] = bi0;
 969           from += 1;
 970           to_next += 1;
 971           n_left_to_next -= 1;
 972           n_left_from -= 1;
 973
 974           b0 = vlib_get_buffer (vm, bi0);
 975
 976           hi0 =
 977             vnet_get_sup_hw_interface (vnm,
 978                                        vnet_buffer (b0)->sw_if_index
 979                                        [VLIB_TX]);
 980
 981           next0 = hi0->output_node_next_index;
 982
 983           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
 984                                            n_left_to_next, bi0, next0);
 985         }
 986
 987       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
 988     }
 989
 990   return frame->n_vectors;
 991 }
 992
 993 typedef struct vnet_error_trace_t_
 994 {
 995   u32 sw_if_index;
 996 } vnet_error_trace_t;
 997
 998
 999 static u8 *
1000 format_vnet_error_trace (u8 * s, va_list * va)
1001 {
1002   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
1003   CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *);
1004   vnet_error_trace_t *t = va_arg (*va, vnet_error_trace_t *);
1005
1006   s = format (s, "rx:%U", format_vnet_sw_if_index_name,
1007               vnet_get_main (), t->sw_if_index);
1008
1009   return s;
1010 }
1011
1012 static void
1013 interface_trace_buffers (vlib_main_t * vm,
1014                          vlib_node_runtime_t * node, vlib_frame_t * frame)
1015 {
1016   u32 n_left, *buffers;
1017
1018   buffers = vlib_frame_vector_args (frame);
1019   n_left = frame->n_vectors;
1020
1021   while (n_left >= 4)
1022     {
1023       u32 bi0, bi1;
1024       vlib_buffer_t *b0, *b1;
1025       vnet_error_trace_t *t0, *t1;
1026
1027       /* Prefetch next iteration. */
1028       vlib_prefetch_buffer_with_index (vm, buffers[2], LOAD);
1029       vlib_prefetch_buffer_with_index (vm, buffers[3], LOAD);
1030
1031       bi0 = buffers[0];
1032       bi1 = buffers[1];
1033
1034       b0 = vlib_get_buffer (vm, bi0);
1035       b1 = vlib_get_buffer (vm, bi1);
1036
1037       if (b0->flags & VLIB_BUFFER_IS_TRACED)
1038         {
1039           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
1040           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
1041         }
1042       if (b1->flags & VLIB_BUFFER_IS_TRACED)
1043         {
1044           t1 = vlib_add_trace (vm, node, b1, sizeof (t1[0]));
1045           t1->sw_if_index = vnet_buffer (b1)->sw_if_index[VLIB_RX];
1046         }
1047       buffers += 2;
1048       n_left -= 2;
1049     }
1050
1051   while (n_left >= 1)
1052     {
1053       u32 bi0;
1054       vlib_buffer_t *b0;
1055       vnet_error_trace_t *t0;
1056
1057       bi0 = buffers[0];
1058
1059       b0 = vlib_get_buffer (vm, bi0);
1060
1061       if (b0->flags & VLIB_BUFFER_IS_TRACED)
1062         {
1063           t0 = vlib_add_trace (vm, node, b0, sizeof (t0[0]));
1064           t0->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
1065         }
1066       buffers += 1;
1067       n_left -= 1;
1068     }
1069 }
1070
1071 typedef enum
1072 {
1073   VNET_ERROR_DISPOSITION_DROP,
1074   VNET_ERROR_DISPOSITION_PUNT,
1075   VNET_ERROR_N_DISPOSITION,
1076 } vnet_error_disposition_t;
1077
1078 static_always_inline uword
1079 interface_drop_punt (vlib_main_t * vm,
1080                      vlib_node_runtime_t * node,
1081                      vlib_frame_t * frame,
1082                      vnet_error_disposition_t disposition)
1083 {
1084   u32 *from, n_left, thread_index, *sw_if_index;
1085   vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b;
1086   u32 sw_if_indices[VLIB_FRAME_SIZE];
1087   vlib_simple_counter_main_t *cm;
1088   u16 nexts[VLIB_FRAME_SIZE];
1089   vnet_main_t *vnm;
1090
1091   vnm = vnet_get_main ();
1092   thread_index = vm->thread_index;
1093   from = vlib_frame_vector_args (frame);
1094   n_left = frame->n_vectors;
1095   b = bufs;
1096   sw_if_index = sw_if_indices;
1097
1098   vlib_get_buffers (vm, from, bufs, n_left);
1099
1100   if (node->flags & VLIB_NODE_FLAG_TRACE)
1101     interface_trace_buffers (vm, node, frame);
1102
1103   /* All going to drop regardless, this is just a counting exercise */
1104   clib_memset (nexts, 0, sizeof (nexts));
1105
1106   cm = vec_elt_at_index (vnm->interface_main.sw_if_counters,
1107                          (disposition == VNET_ERROR_DISPOSITION_PUNT
1108                           ? VNET_INTERFACE_COUNTER_PUNT
1109                           : VNET_INTERFACE_COUNTER_DROP));
1110
1111   /* collect the array of interfaces first ... */
1112   while (n_left >= 4)
1113     {
1114       if (n_left >= 12)
1115         {
1116           /* Prefetch 8 ahead - there's not much going on in each iteration */
1117           vlib_prefetch_buffer_header (b[4], LOAD);
1118           vlib_prefetch_buffer_header (b[5], LOAD);
1119           vlib_prefetch_buffer_header (b[6], LOAD);
1120           vlib_prefetch_buffer_header (b[7], LOAD);
1121         }
1122       sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_RX];
1123       sw_if_index[1] = vnet_buffer (b[1])->sw_if_index[VLIB_RX];
1124       sw_if_index[2] = vnet_buffer (b[2])->sw_if_index[VLIB_RX];
1125       sw_if_index[3] = vnet_buffer (b[3])->sw_if_index[VLIB_RX];
1126
1127       sw_if_index += 4;
1128       n_left -= 4;
1129       b += 4;
1130     }
1131   while (n_left)
1132     {
1133       sw_if_index[0] = vnet_buffer (b[0])->sw_if_index[VLIB_RX];
1134
1135       sw_if_index += 1;
1136       n_left -= 1;
1137       b += 1;
1138     }
1139
1140   /* ... then count against them in blocks */
1141   n_left = frame->n_vectors;
1142
1143   while (n_left)
1144     {
1145       vnet_sw_interface_t *sw_if0;
1146       u16 off, count;
1147
1148       off = frame->n_vectors - n_left;
1149
1150       sw_if_index = sw_if_indices + off;
1151
1152       count = clib_count_equal_u32 (sw_if_index, n_left);
1153       n_left -= count;
1154
1155       vlib_increment_simple_counter (cm, thread_index, sw_if_index[0], count);
1156
1157       /* Increment super-interface drop/punt counters for
1158          sub-interfaces. */
1159       sw_if0 = vnet_get_sw_interface (vnm, sw_if_index[0]);
1160       if (sw_if0->sup_sw_if_index != sw_if_index[0])
1161         vlib_increment_simple_counter
1162           (cm, thread_index, sw_if0->sup_sw_if_index, count);
1163     }
1164
1165   vlib_buffer_enqueue_to_next (vm, node, from, nexts, frame->n_vectors);
1166
1167   return frame->n_vectors;
1168 }
1169
1170 static inline void
1171 pcap_drop_trace (vlib_main_t * vm,
1172                  vnet_interface_main_t * im, vlib_frame_t * f)
1173 {
1174   u32 *from;
1175   u32 n_left = f->n_vectors;
1176   vlib_buffer_t *b0, *p1;
1177   u32 bi0;
1178   i16 save_current_data;
1179   u16 save_current_length;
1180
1181   from = vlib_frame_vector_args (f);
1182
1183   while (n_left > 0)
1184     {
1185       if (PREDICT_TRUE (n_left > 1))
1186         {
1187           p1 = vlib_get_buffer (vm, from[1]);
1188           vlib_prefetch_buffer_header (p1, LOAD);
1189         }
1190
1191       bi0 = from[0];
1192       b0 = vlib_get_buffer (vm, bi0);
1193       from++;
1194       n_left--;
1195
1196       /* See if we're pointedly ignoring this specific error */
1197       if (im->pcap_drop_filter_hash
1198           && hash_get (im->pcap_drop_filter_hash, b0->error))
1199         continue;
1200
1201       /* Trace all drops, or drops received on a specific interface */
1202       if (im->pcap_sw_if_index == 0 ||
1203           im->pcap_sw_if_index == vnet_buffer (b0)->sw_if_index[VLIB_RX])
1204         {
1205           save_current_data = b0->current_data;
1206           save_current_length = b0->current_length;
1207
1208           /*
1209            * Typically, we'll need to rewind the buffer
1210            * if l2_hdr_offset is valid, make sure to rewind to the start of
1211            * the L2 header. This may not be the buffer start in case we pop-ed
1212            * vlan tags.
1213            * Otherwise, rewind to buffer start and hope for the best.
1214            */
1215           if (b0->flags & VNET_BUFFER_F_L2_HDR_OFFSET_VALID)
1216             {
1217               if (b0->current_data > vnet_buffer (b0)->l2_hdr_offset)
1218                 vlib_buffer_advance (b0,
1219                                      vnet_buffer (b0)->l2_hdr_offset -
1220                                      b0->current_data);
1221             }
1222           else if (b0->current_data > 0)
1223             vlib_buffer_advance (b0, (word) - b0->current_data);
1224
1225           pcap_add_buffer (&im->pcap_main, vm, bi0, 512);
1226
1227           b0->current_data = save_current_data;
1228           b0->current_length = save_current_length;
1229         }
1230     }
1231 }
1232
1233 #ifndef CLIB_MARCH_VARIANT
1234 void
1235 vnet_pcap_drop_trace_filter_add_del (u32 error_index, int is_add)
1236 {
1237   vnet_interface_main_t *im = &vnet_get_main ()->interface_main;
1238
1239   if (im->pcap_drop_filter_hash == 0)
1240     im->pcap_drop_filter_hash = hash_create (0, sizeof (uword));
1241
1242   if (is_add)
1243     hash_set (im->pcap_drop_filter_hash, error_index, 1);
1244   else
1245     hash_unset (im->pcap_drop_filter_hash, error_index);
1246 }
1247 #endif /* CLIB_MARCH_VARIANT */
1248
1249 VLIB_NODE_FN (interface_drop) (vlib_main_t * vm,
1250                                vlib_node_runtime_t * node,
1251                                vlib_frame_t * frame)
1252 {
1253   vnet_interface_main_t *im = &vnet_get_main ()->interface_main;
1254
1255   if (PREDICT_FALSE (im->drop_pcap_enable))
1256     pcap_drop_trace (vm, im, frame);
1257
1258   return interface_drop_punt (vm, node, frame, VNET_ERROR_DISPOSITION_DROP);
1259 }
1260
1261 VLIB_NODE_FN (interface_punt) (vlib_main_t * vm,
1262                                vlib_node_runtime_t * node,
1263                                vlib_frame_t * frame)
1264 {
1265   return interface_drop_punt (vm, node, frame, VNET_ERROR_DISPOSITION_PUNT);
1266 }
1267
1268 /* *INDENT-OFF* */
1269 VLIB_REGISTER_NODE (interface_drop) = {
1270   .name = "error-drop",
1271   .vector_size = sizeof (u32),
1272   .format_trace = format_vnet_error_trace,
1273   .n_next_nodes = 1,
1274   .next_nodes = {
1275     [0] = "drop",
1276   },
1277 };
1278 /* *INDENT-ON* */
1279
1280 /* *INDENT-OFF* */
1281 VLIB_REGISTER_NODE (interface_punt) = {
1282   .name = "error-punt",
1283   .vector_size = sizeof (u32),
1284   .format_trace = format_vnet_error_trace,
1285   .n_next_nodes = 1,
1286   .next_nodes = {
1287     [0] = "punt",
1288   },
1289 };
1290 /* *INDENT-ON* */
1291
1292 /* *INDENT-OFF* */
1293 VLIB_REGISTER_NODE (vnet_per_buffer_interface_output_node) = {
1294   .name = "interface-output",
1295   .vector_size = sizeof (u32),
1296 };
1297 /* *INDENT-ON* */
1298
1299 static uword
1300 interface_tx_node_fn (vlib_main_t * vm, vlib_node_runtime_t * node,
1301                       vlib_frame_t * from_frame)
1302 {
1303   vnet_main_t *vnm = vnet_get_main ();
1304   u32 last_sw_if_index = ~0;
1305   vlib_frame_t *to_frame = 0;
1306   vnet_hw_interface_t *hw = 0;
1307   u32 *from, *to_next = 0;
1308   u32 n_left_from;
1309
1310   from = vlib_frame_vector_args (from_frame);
1311   n_left_from = from_frame->n_vectors;
1312   while (n_left_from > 0)
1313     {
1314       u32 bi0;
1315       vlib_buffer_t *b0;
1316       u32 sw_if_index0;
1317
1318       bi0 = from[0];
1319       from++;
1320       n_left_from--;
1321       b0 = vlib_get_buffer (vm, bi0);
1322       sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_TX];
1323
1324       if (PREDICT_FALSE ((last_sw_if_index != sw_if_index0) || to_frame == 0))
1325         {
1326           if (to_frame)
1327             {
1328               hw = vnet_get_sup_hw_interface (vnm, last_sw_if_index);
1329               vlib_put_frame_to_node (vm, hw->tx_node_index, to_frame);
1330             }
1331           last_sw_if_index = sw_if_index0;
1332           hw = vnet_get_sup_hw_interface (vnm, sw_if_index0);
1333           to_frame = vlib_get_frame_to_node (vm, hw->tx_node_index);
1334           to_next = vlib_frame_vector_args (to_frame);
1335         }
1336
1337       to_next[0] = bi0;
1338       to_next++;
1339       to_frame->n_vectors++;
1340     }
1341   vlib_put_frame_to_node (vm, hw->tx_node_index, to_frame);
1342   return from_frame->n_vectors;
1343 }
1344
1345 /* *INDENT-OFF* */
1346 VLIB_REGISTER_NODE (interface_tx) = {
1347   .function = interface_tx_node_fn,
1348   .name = "interface-tx",
1349   .vector_size = sizeof (u32),
1350   .n_next_nodes = 1,
1351   .next_nodes = {
1352     [0] = "error-drop",
1353   },
1354 };
1355
1356 VNET_FEATURE_ARC_INIT (interface_output, static) =
1357 {
1358   .arc_name  = "interface-output",
1359   .start_nodes = VNET_FEATURES (0),
1360   .last_in_arc = "interface-tx",
1361   .arc_index_ptr = &vnet_main.interface_main.output_feature_arc_index,
1362 };
1363
1364 VNET_FEATURE_INIT (span_tx, static) = {
1365   .arc_name = "interface-output",
1366   .node_name = "span-output",
1367   .runs_before = VNET_FEATURES ("interface-tx"),
1368 };
1369
1370 VNET_FEATURE_INIT (ipsec_if_tx, static) = {
1371   .arc_name = "interface-output",
1372   .node_name = "ipsec-if-output",
1373   .runs_before = VNET_FEATURES ("interface-tx"),
1374 };
1375
1376 VNET_FEATURE_INIT (interface_tx, static) = {
1377   .arc_name = "interface-output",
1378   .node_name = "interface-tx",
1379   .runs_before = 0,
1380 };
1381 /* *INDENT-ON* */
1382
1383 #ifndef CLIB_MARCH_VARIANT
1384 clib_error_t *
1385 vnet_per_buffer_interface_output_hw_interface_add_del (vnet_main_t * vnm,
1386                                                        u32 hw_if_index,
1387                                                        u32 is_create)
1388 {
1389   vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index);
1390   u32 next_index;
1391
1392   if (hi->output_node_index == 0)
1393     return 0;
1394
1395   next_index = vlib_node_add_next
1396     (vnm->vlib_main, vnet_per_buffer_interface_output_node.index,
1397      hi->output_node_index);
1398   hi->output_node_next_index = next_index;
1399
1400   return 0;
1401 }
1402
1403 VNET_HW_INTERFACE_ADD_DEL_FUNCTION
1404   (vnet_per_buffer_interface_output_hw_interface_add_del);
1405
1406 void
1407 vnet_set_interface_output_node (vnet_main_t * vnm,
1408                                 u32 hw_if_index, u32 node_index)
1409 {
1410   ASSERT (node_index);
1411   vnet_hw_interface_t *hi = vnet_get_hw_interface (vnm, hw_if_index);
1412   u32 next_index = vlib_node_add_next
1413     (vnm->vlib_main, vnet_per_buffer_interface_output_node.index, node_index);
1414   hi->output_node_next_index = next_index;
1415   hi->output_node_index = node_index;
1416 }
1417 #endif /* CLIB_MARCH_VARIANT */
1418
1419 static clib_error_t *
1420 pcap_drop_trace_command_fn (vlib_main_t * vm,
1421                             unformat_input_t * input,
1422                             vlib_cli_command_t * cmd)
1423 {
1424   vnet_main_t *vnm = vnet_get_main ();
1425   vnet_interface_main_t *im = &vnm->interface_main;
1426   u8 *filename;
1427   u32 max;
1428   int matched = 0;
1429   clib_error_t *error = 0;
1430
1431   while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT)
1432     {
1433       if (unformat (input, "on"))
1434         {
1435           if (im->drop_pcap_enable == 0)
1436             {
1437               if (im->pcap_filename == 0)
1438                 im->pcap_filename = format (0, "/tmp/drop.pcap%c", 0);
1439
1440               clib_memset (&im->pcap_main, 0, sizeof (im->pcap_main));
1441               im->pcap_main.file_name = (char *) im->pcap_filename;
1442               im->pcap_main.n_packets_to_capture = PCAP_DEF_PKT_TO_CAPTURE;
1443               if (im->pcap_pkts_to_capture)
1444                 im->pcap_main.n_packets_to_capture = im->pcap_pkts_to_capture;
1445
1446               im->pcap_main.packet_type = PCAP_PACKET_TYPE_ethernet;
1447               im->drop_pcap_enable = 1;
1448               matched = 1;
1449               vlib_cli_output (vm, "pcap drop capture on...");
1450             }
1451           else
1452             {
1453               vlib_cli_output (vm, "pcap drop capture already on...");
1454             }
1455           matched = 1;
1456         }
1457       else if (unformat (input, "off"))
1458         {
1459           matched = 1;
1460
1461           if (im->drop_pcap_enable)
1462             {
1463               vlib_cli_output (vm, "captured %d pkts...",
1464                                im->pcap_main.n_packets_captured);
1465               if (im->pcap_main.n_packets_captured)
1466                 {
1467                   im->pcap_main.n_packets_to_capture =
1468                     im->pcap_main.n_packets_captured;
1469                   error = pcap_write (&im->pcap_main);
1470                   if (im->pcap_main.flags & PCAP_MAIN_INIT_DONE)
1471                     pcap_close (&im->pcap_main);
1472                   if (error)
1473                     clib_error_report (error);
1474                   else
1475                     vlib_cli_output (vm, "saved to %s...", im->pcap_filename);
1476                 }
1477             }
1478           else
1479             {
1480               vlib_cli_output (vm, "pcap drop capture already off...");
1481             }
1482
1483           im->drop_pcap_enable = 0;
1484         }
1485       else if (unformat (input, "max %d", &max))
1486         {
1487           im->pcap_pkts_to_capture = max;
1488           matched = 1;
1489         }
1490
1491       else if (unformat (input, "intfc %U",
1492                          unformat_vnet_sw_interface, vnm,
1493                          &im->pcap_sw_if_index))
1494         matched = 1;
1495       else if (unformat (input, "intfc any"))
1496         {
1497           im->pcap_sw_if_index = 0;
1498           matched = 1;
1499         }
1500       else if (unformat (input, "file %s", &filename))
1501         {
1502           u8 *chroot_filename;
1503           /* Brain-police user path input */
1504           if (strstr ((char *) filename, "..")
1505               || index ((char *) filename, '/'))
1506             {
1507               vlib_cli_output (vm, "illegal characters in filename '%s'",
1508                                filename);
1509               continue;
1510             }
1511
1512           chroot_filename = format (0, "/tmp/%s%c", filename, 0);
1513           vec_free (filename);
1514
1515           if (im->pcap_filename)
1516             vec_free (im->pcap_filename);
1517           im->pcap_filename = chroot_filename;
1518           im->pcap_main.file_name = (char *) im->pcap_filename;
1519           matched = 1;
1520         }
1521       else if (unformat (input, "status"))
1522         {
1523           if (im->drop_pcap_enable == 0)
1524             {
1525               vlib_cli_output (vm, "pcap drop capture is off...");
1526               continue;
1527             }
1528
1529           vlib_cli_output (vm, "pcap drop capture: %d of %d pkts...",
1530                            im->pcap_main.n_packets_captured,
1531                            im->pcap_main.n_packets_to_capture);
1532           matched = 1;
1533         }
1534
1535       else
1536         break;
1537     }
1538
1539   if (matched == 0)
1540     return clib_error_return (0, "unknown input `%U'",
1541                               format_unformat_error, input);
1542
1543   return 0;
1544 }
1545
1546 /* *INDENT-OFF* */
1547 VLIB_CLI_COMMAND (pcap_trace_command, static) = {
1548   .path = "pcap drop trace",
1549   .short_help =
1550   "pcap drop trace on off max <nn> intfc <intfc> file <name> status",
1551   .function = pcap_drop_trace_command_fn,
1552 };
1553 /* *INDENT-ON* */
1554
1555 /*
1556  * fd.io coding-style-patch-verification: ON
1557  *
1558  * Local Variables:
1559  * eval: (c-set-style "gnu")
1560  * End:
1561  */