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