src/vnet/gso/node.c

   1 /*
   2  * Copyright (c) 2018 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 #include <vlib/vlib.h>
  17 #include <vnet/vnet.h>
  18 #include <vppinfra/error.h>
  19 #include <vnet/ethernet/ethernet.h>
  20 #include <vnet/feature/feature.h>
  21 #include <vnet/gso/gso.h>
  22 #include <vnet/gso/hdr_offset_parser.h>
  23 #include <vnet/ip/icmp46_packet.h>
  24 #include <vnet/ip/ip4.h>
  25 #include <vnet/ip/ip6.h>
  26 #include <vnet/udp/udp_packet.h>
  27
  28 #define foreach_gso_error                                                     \
  29   _ (NO_BUFFERS, "no buffers to segment GSO")                                 \
  30   _ (UNHANDLED_TYPE, "unhandled gso type")
  31
  32 static char *gso_error_strings[] = {
  33 #define _(sym, string) string,
  34   foreach_gso_error
  35 #undef _
  36 };
  37
  38 typedef enum
  39 {
  40 #define _(sym, str) GSO_ERROR_##sym,
  41   foreach_gso_error
  42 #undef _
  43     GSO_N_ERROR,
  44 } gso_error_t;
  45
  46 typedef enum
  47 {
  48   GSO_NEXT_DROP,
  49   GSO_N_NEXT,
  50 } gso_next_t;
  51
  52 typedef struct
  53 {
  54   u32 flags;
  55   u16 gso_size;
  56   u8 gso_l4_hdr_sz;
  57   generic_header_offset_t gho;
  58 } gso_trace_t;
  59
  60 static u8 *
  61 format_gso_trace (u8 * s, va_list * args)
  62 {
  63   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
  64   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
  65   gso_trace_t *t = va_arg (*args, gso_trace_t *);
  66
  67   if (t->flags & VNET_BUFFER_F_GSO)
  68     {
  69       s = format (s, "gso_sz %d gso_l4_hdr_sz %d\n%U",
  70                   t->gso_size, t->gso_l4_hdr_sz, format_generic_header_offset,
  71                   &t->gho);
  72     }
  73   else
  74     {
  75       s =
  76         format (s, "non-gso buffer\n%U", format_generic_header_offset,
  77                 &t->gho);
  78     }
  79
  80   return s;
  81 }
  82
  83 static_always_inline u16
  84 tso_segment_ipip_tunnel_fixup (vlib_main_t * vm,
  85                                vnet_interface_per_thread_data_t * ptd,
  86                                vlib_buffer_t * sb0,
  87                                generic_header_offset_t * gho)
  88 {
  89   u16 n_tx_bufs = vec_len (ptd->split_buffers);
  90   u16 i = 0, n_tx_bytes = 0;
  91
  92   while (i < n_tx_bufs)
  93     {
  94       vlib_buffer_t *b0 = vlib_get_buffer (vm, ptd->split_buffers[i]);
  95
  96       ip4_header_t *ip4 =
  97         (ip4_header_t *) (vlib_buffer_get_current (b0) +
  98                           gho->outer_l3_hdr_offset);
  99       ip6_header_t *ip6 =
 100         (ip6_header_t *) (vlib_buffer_get_current (b0) +
 101                           gho->outer_l3_hdr_offset);
 102
 103       if (gho->gho_flags & GHO_F_OUTER_IP4)
 104         {
 105           ip4->length =
 106             clib_host_to_net_u16 (b0->current_length -
 107                                   gho->outer_l3_hdr_offset);
 108           ip4->checksum = ip4_header_checksum (ip4);
 109         }
 110       else if (gho->gho_flags & GHO_F_OUTER_IP6)
 111         {
 112           ip6->payload_length =
 113             clib_host_to_net_u16 (b0->current_length -
 114                                   gho->outer_l4_hdr_offset);
 115         }
 116
 117       n_tx_bytes += gho->outer_hdr_sz;
 118       i++;
 119     }
 120   return n_tx_bytes;
 121 }
 122
 123 static_always_inline void
 124 tso_segment_vxlan_tunnel_headers_fixup (vlib_main_t * vm, vlib_buffer_t * b,
 125                                         generic_header_offset_t * gho)
 126 {
 127   u8 proto = 0;
 128   ip4_header_t *ip4 = 0;
 129   ip6_header_t *ip6 = 0;
 130   udp_header_t *udp = 0;
 131
 132   ip4 =
 133     (ip4_header_t *) (vlib_buffer_get_current (b) + gho->outer_l3_hdr_offset);
 134   ip6 =
 135     (ip6_header_t *) (vlib_buffer_get_current (b) + gho->outer_l3_hdr_offset);
 136   udp =
 137     (udp_header_t *) (vlib_buffer_get_current (b) + gho->outer_l4_hdr_offset);
 138
 139   if (gho->gho_flags & GHO_F_OUTER_IP4)
 140     {
 141       proto = ip4->protocol;
 142       ip4->length =
 143         clib_host_to_net_u16 (b->current_length - gho->outer_l3_hdr_offset);
 144       ip4->checksum = ip4_header_checksum (ip4);
 145     }
 146   else if (gho->gho_flags & GHO_F_OUTER_IP6)
 147     {
 148       proto = ip6->protocol;
 149       ip6->payload_length =
 150         clib_host_to_net_u16 (b->current_length - gho->outer_l4_hdr_offset);
 151     }
 152   if (proto == IP_PROTOCOL_UDP)
 153     {
 154       int bogus;
 155       udp->length =
 156         clib_host_to_net_u16 (b->current_length - gho->outer_l4_hdr_offset);
 157       udp->checksum = 0;
 158       if (gho->gho_flags & GHO_F_OUTER_IP6)
 159         {
 160           udp->checksum =
 161             ip6_tcp_udp_icmp_compute_checksum (vm, b, ip6, &bogus);
 162         }
 163       else if (gho->gho_flags & GHO_F_OUTER_IP4)
 164         {
 165           udp->checksum = ip4_tcp_udp_compute_checksum (vm, b, ip4);
 166         }
 167       /* FIXME: it should be OUTER_UDP_CKSUM */
 168       vnet_buffer_offload_flags_clear (b, VNET_BUFFER_OFFLOAD_F_UDP_CKSUM);
 169     }
 170 }
 171
 172 static_always_inline u16
 173 tso_segment_vxlan_tunnel_fixup (vlib_main_t * vm,
 174                                 vnet_interface_per_thread_data_t * ptd,
 175                                 vlib_buffer_t * sb0,
 176                                 generic_header_offset_t * gho)
 177 {
 178   u16 n_tx_bufs = vec_len (ptd->split_buffers);
 179   u16 i = 0, n_tx_bytes = 0;
 180
 181   while (i < n_tx_bufs)
 182     {
 183       vlib_buffer_t *b0 = vlib_get_buffer (vm, ptd->split_buffers[i]);
 184
 185       tso_segment_vxlan_tunnel_headers_fixup (vm, b0, gho);
 186       n_tx_bytes += gho->outer_hdr_sz;
 187       i++;
 188     }
 189   return n_tx_bytes;
 190 }
 191
 192 static_always_inline u16
 193 tso_alloc_tx_bufs (vlib_main_t * vm,
 194                    vnet_interface_per_thread_data_t * ptd,
 195                    vlib_buffer_t * b0, u32 n_bytes_b0, u16 l234_sz,
 196                    u16 gso_size, u16 first_data_size,
 197                    generic_header_offset_t * gho)
 198 {
 199   u16 n_alloc, size;
 200   u16 first_packet_length = l234_sz + first_data_size;
 201
 202   /*
 203    * size is the amount of data per segmented buffer except the 1st
 204    * segmented buffer.
 205    * l2_hdr_offset is an offset == current_data of vlib_buffer_t.
 206    * l234_sz is hdr_sz from l2_hdr_offset.
 207    */
 208   size =
 209     clib_min (gso_size, vlib_buffer_get_default_data_size (vm) - l234_sz
 210               - gho->l2_hdr_offset);
 211
 212   /*
 213    * First segmented buffer length is calculated separately.
 214    * As it may contain less data than gso_size (when gso_size is
 215    * greater than current_length of 1st buffer from GSO chained
 216    * buffers) and/or size calculated above.
 217    */
 218   u16 n_bufs = 1;
 219
 220   /*
 221    * Total packet length minus first packet length including l234 header.
 222    * rounded-up division
 223    */
 224   ASSERT (n_bytes_b0 > first_packet_length);
 225   n_bufs += ((n_bytes_b0 - first_packet_length + (size - 1)) / size);
 226
 227   vec_validate (ptd->split_buffers, n_bufs - 1);
 228
 229   n_alloc = vlib_buffer_alloc (vm, ptd->split_buffers, n_bufs);
 230   if (n_alloc < n_bufs)
 231     {
 232       vlib_buffer_free (vm, ptd->split_buffers, n_alloc);
 233       return 0;
 234     }
 235   return n_alloc;
 236 }
 237
 238 static_always_inline void
 239 tso_init_buf_from_template_base (vlib_buffer_t * nb0, vlib_buffer_t * b0,
 240                                  u32 flags, u16 length)
 241 {
 242   /* copying objects from cacheline 0 */
 243   nb0->current_data = b0->current_data;
 244   nb0->current_length = length;
 245   nb0->flags = VLIB_BUFFER_TOTAL_LENGTH_VALID | flags;
 246   nb0->flow_id = b0->flow_id;
 247   nb0->error = b0->error;
 248   nb0->current_config_index = b0->current_config_index;
 249   clib_memcpy_fast (&nb0->opaque, &b0->opaque, sizeof (nb0->opaque));
 250
 251   /* copying objects from cacheline 1 */
 252   nb0->trace_handle = b0->trace_handle;
 253   nb0->total_length_not_including_first_buffer = 0;
 254
 255   /* copying data */
 256   clib_memcpy_fast (vlib_buffer_get_current (nb0),
 257                     vlib_buffer_get_current (b0), length);
 258 }
 259
 260 static_always_inline void
 261 tso_init_buf_from_template (vlib_main_t * vm, vlib_buffer_t * nb0,
 262                             vlib_buffer_t * b0, u16 template_data_sz,
 263                             u16 gso_size, u8 ** p_dst_ptr, u16 * p_dst_left,
 264                             u32 next_tcp_seq, u32 flags,
 265                             generic_header_offset_t * gho)
 266 {
 267   tso_init_buf_from_template_base (nb0, b0, flags, template_data_sz);
 268
 269   *p_dst_left =
 270     clib_min (gso_size,
 271               vlib_buffer_get_default_data_size (vm) - (template_data_sz +
 272                                                         nb0->current_data));
 273   *p_dst_ptr = vlib_buffer_get_current (nb0) + template_data_sz;
 274
 275   tcp_header_t *tcp =
 276     (tcp_header_t *) (vlib_buffer_get_current (nb0) + gho->l4_hdr_offset);
 277   tcp->seq_number = clib_host_to_net_u32 (next_tcp_seq);
 278 }
 279
 280 static_always_inline void
 281 tso_fixup_segmented_buf (vlib_main_t * vm, vlib_buffer_t * b0, u8 tcp_flags,
 282                          int is_l2, int is_ip6, generic_header_offset_t * gho)
 283 {
 284   ip4_header_t *ip4 =
 285     (ip4_header_t *) (vlib_buffer_get_current (b0) + gho->l3_hdr_offset);
 286   ip6_header_t *ip6 =
 287     (ip6_header_t *) (vlib_buffer_get_current (b0) + gho->l3_hdr_offset);
 288   tcp_header_t *tcp =
 289     (tcp_header_t *) (vlib_buffer_get_current (b0) + gho->l4_hdr_offset);
 290
 291   tcp->flags = tcp_flags;
 292
 293   if (is_ip6)
 294     {
 295       ip6->payload_length =
 296         clib_host_to_net_u16 (b0->current_length - gho->l4_hdr_offset);
 297       if (gho->gho_flags & GHO_F_TCP)
 298         {
 299           int bogus = 0;
 300           tcp->checksum = 0;
 301           tcp->checksum =
 302             ip6_tcp_udp_icmp_compute_checksum (vm, b0, ip6, &bogus);
 303           vnet_buffer_offload_flags_clear (b0,
 304                                            VNET_BUFFER_OFFLOAD_F_TCP_CKSUM);
 305         }
 306     }
 307   else
 308     {
 309       ip4->length =
 310         clib_host_to_net_u16 (b0->current_length - gho->l3_hdr_offset);
 311       if (gho->gho_flags & GHO_F_IP4)
 312         ip4->checksum = ip4_header_checksum (ip4);
 313       if (gho->gho_flags & GHO_F_TCP)
 314         {
 315           tcp->checksum = 0;
 316           tcp->checksum = ip4_tcp_udp_compute_checksum (vm, b0, ip4);
 317         }
 318       vnet_buffer_offload_flags_clear (b0, (VNET_BUFFER_OFFLOAD_F_IP_CKSUM |
 319                                             VNET_BUFFER_OFFLOAD_F_TCP_CKSUM));
 320     }
 321
 322   if (!is_l2 && ((gho->gho_flags & GHO_F_TUNNEL) == 0))
 323     {
 324       u32 adj_index0 = vnet_buffer (b0)->ip.adj_index[VLIB_TX];
 325
 326       ip_adjacency_t *adj0 = adj_get (adj_index0);
 327
 328       if (adj0->lookup_next_index == IP_LOOKUP_NEXT_MIDCHAIN &&
 329           adj0->sub_type.midchain.fixup_func)
 330         /* calls e.g. ipip44_fixup */
 331         adj0->sub_type.midchain.fixup_func
 332           (vm, adj0, b0, adj0->sub_type.midchain.fixup_data);
 333     }
 334 }
 335
 336 /**
 337  * Allocate the necessary number of ptd->split_buffers,
 338  * and segment the possibly chained buffer(s) from b0 into
 339  * there.
 340  *
 341  * Return the cumulative number of bytes sent or zero
 342  * if allocation failed.
 343  */
 344
 345 static_always_inline u32
 346 tso_segment_buffer (vlib_main_t * vm, vnet_interface_per_thread_data_t * ptd,
 347                     u32 sbi0, vlib_buffer_t * sb0,
 348                     generic_header_offset_t * gho, u32 n_bytes_b0, int is_l2,
 349                     int is_ip6)
 350 {
 351   u32 n_tx_bytes = 0;
 352   u16 gso_size = vnet_buffer2 (sb0)->gso_size;
 353
 354   u8 save_tcp_flags = 0;
 355   u8 tcp_flags_no_fin_psh = 0;
 356   u32 next_tcp_seq = 0;
 357
 358   tcp_header_t *tcp =
 359     (tcp_header_t *) (vlib_buffer_get_current (sb0) + gho->l4_hdr_offset);
 360   next_tcp_seq = clib_net_to_host_u32 (tcp->seq_number);
 361   /* store original flags for last packet and reset FIN and PSH */
 362   save_tcp_flags = tcp->flags;
 363   tcp_flags_no_fin_psh = tcp->flags & ~(TCP_FLAG_FIN | TCP_FLAG_PSH);
 364   tcp->checksum = 0;
 365
 366   u32 default_bflags =
 367     sb0->flags & ~(VNET_BUFFER_F_GSO | VLIB_BUFFER_NEXT_PRESENT);
 368   u16 l234_sz = gho->hdr_sz;
 369   int first_data_size = clib_min (gso_size, sb0->current_length - l234_sz);
 370   next_tcp_seq += first_data_size;
 371
 372   if (PREDICT_FALSE
 373       (!tso_alloc_tx_bufs
 374        (vm, ptd, sb0, n_bytes_b0, l234_sz, gso_size, first_data_size, gho)))
 375     return 0;
 376
 377   vlib_buffer_t *b0 = vlib_get_buffer (vm, ptd->split_buffers[0]);
 378   tso_init_buf_from_template_base (b0, sb0, default_bflags,
 379                                    l234_sz + first_data_size);
 380
 381   u32 total_src_left = n_bytes_b0 - l234_sz - first_data_size;
 382   if (total_src_left)
 383     {
 384       /* Need to copy more segments */
 385       u8 *src_ptr, *dst_ptr;
 386       u16 src_left, dst_left;
 387       /* current source buffer */
 388       vlib_buffer_t *csb0 = sb0;
 389       u32 csbi0 = sbi0;
 390       /* current dest buffer */
 391       vlib_buffer_t *cdb0;
 392       u16 dbi = 1;              /* the buffer [0] is b0 */
 393
 394       src_ptr = vlib_buffer_get_current (sb0) + l234_sz + first_data_size;
 395       src_left = sb0->current_length - l234_sz - first_data_size;
 396
 397       tso_fixup_segmented_buf (vm, b0, tcp_flags_no_fin_psh, is_l2, is_ip6,
 398                                gho);
 399
 400       /* grab a second buffer and prepare the loop */
 401       ASSERT (dbi < vec_len (ptd->split_buffers));
 402       cdb0 = vlib_get_buffer (vm, ptd->split_buffers[dbi++]);
 403       tso_init_buf_from_template (vm, cdb0, b0, l234_sz, gso_size, &dst_ptr,
 404                                   &dst_left, next_tcp_seq, default_bflags,
 405                                   gho);
 406
 407       /* an arbitrary large number to catch the runaway loops */
 408       int nloops = 2000;
 409       while (total_src_left)
 410         {
 411           if (nloops-- <= 0)
 412             clib_panic ("infinite loop detected");
 413           u16 bytes_to_copy = clib_min (src_left, dst_left);
 414
 415           clib_memcpy_fast (dst_ptr, src_ptr, bytes_to_copy);
 416
 417           src_left -= bytes_to_copy;
 418           src_ptr += bytes_to_copy;
 419           total_src_left -= bytes_to_copy;
 420           dst_left -= bytes_to_copy;
 421           dst_ptr += bytes_to_copy;
 422           next_tcp_seq += bytes_to_copy;
 423           cdb0->current_length += bytes_to_copy;
 424
 425           if (0 == src_left)
 426             {
 427               int has_next = (csb0->flags & VLIB_BUFFER_NEXT_PRESENT);
 428               u32 next_bi = csb0->next_buffer;
 429
 430               /* init src to the next buffer in chain */
 431               if (has_next)
 432                 {
 433                   csbi0 = next_bi;
 434                   csb0 = vlib_get_buffer (vm, csbi0);
 435                   src_left = csb0->current_length;
 436                   src_ptr = vlib_buffer_get_current (csb0);
 437                 }
 438               else
 439                 {
 440                   ASSERT (total_src_left == 0);
 441                   break;
 442                 }
 443             }
 444           if (0 == dst_left && total_src_left)
 445             {
 446               n_tx_bytes += cdb0->current_length;
 447               tso_fixup_segmented_buf (vm, cdb0, tcp_flags_no_fin_psh, is_l2,
 448                                        is_ip6, gho);
 449               ASSERT (dbi < vec_len (ptd->split_buffers));
 450               cdb0 = vlib_get_buffer (vm, ptd->split_buffers[dbi++]);
 451               tso_init_buf_from_template (vm, cdb0, b0, l234_sz,
 452                                           gso_size, &dst_ptr, &dst_left,
 453                                           next_tcp_seq, default_bflags, gho);
 454             }
 455         }
 456
 457       tso_fixup_segmented_buf (vm, cdb0, save_tcp_flags, is_l2, is_ip6, gho);
 458
 459       n_tx_bytes += cdb0->current_length;
 460     }
 461   n_tx_bytes += b0->current_length;
 462   return n_tx_bytes;
 463 }
 464
 465 __clib_unused u32
 466 gso_segment_buffer (vlib_main_t *vm, vnet_interface_per_thread_data_t *ptd,
 467                     u32 bi, vlib_buffer_t *b, generic_header_offset_t *gho,
 468                     u32 n_bytes_b, u8 is_l2, u8 is_ip6)
 469 {
 470
 471   return tso_segment_buffer (vm, ptd, bi, b, gho, n_bytes_b, is_l2, is_ip6);
 472 }
 473
 474 static_always_inline void
 475 drop_one_buffer_and_count (vlib_main_t * vm, vnet_main_t * vnm,
 476                            vlib_node_runtime_t * node, u32 * pbi0,
 477                            u32 sw_if_index, u32 drop_error_code)
 478 {
 479   u32 thread_index = vm->thread_index;
 480
 481   vlib_simple_counter_main_t *cm;
 482   cm =
 483     vec_elt_at_index (vnm->interface_main.sw_if_counters,
 484                       VNET_INTERFACE_COUNTER_TX_ERROR);
 485   vlib_increment_simple_counter (cm, thread_index, sw_if_index, 1);
 486
 487   vlib_error_drop_buffers (vm, node, pbi0,
 488                            /* buffer stride */ 1,
 489                            /* n_buffers */ 1, GSO_NEXT_DROP, node->node_index,
 490                            drop_error_code);
 491 }
 492
 493 static_always_inline uword
 494 vnet_gso_node_inline (vlib_main_t * vm,
 495                       vlib_node_runtime_t * node,
 496                       vlib_frame_t * frame,
 497                       vnet_main_t * vnm,
 498                       vnet_hw_interface_t * hi,
 499                       int is_l2, int is_ip4, int is_ip6, int do_segmentation)
 500 {
 501   u32 *to_next;
 502   u32 next_index = node->cached_next_index;
 503   u32 *from = vlib_frame_vector_args (frame);
 504   u32 n_left_from = frame->n_vectors;
 505   u32 *from_end = from + n_left_from;
 506   u32 thread_index = vm->thread_index;
 507   vnet_interface_main_t *im = &vnm->interface_main;
 508   vnet_interface_per_thread_data_t *ptd =
 509     vec_elt_at_index (im->per_thread_data, thread_index);
 510   vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b = bufs;
 511
 512   vlib_get_buffers (vm, from, b, n_left_from);
 513
 514   while (n_left_from > 0)
 515     {
 516       u32 n_left_to_next;
 517
 518       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
 519
 520       if (!do_segmentation)
 521         while (from + 8 <= from_end && n_left_to_next >= 4)
 522           {
 523             u32 bi0, bi1, bi2, bi3;
 524             u32 next0, next1, next2, next3;
 525             u32 swif0, swif1, swif2, swif3;
 526             gso_trace_t *t0, *t1, *t2, *t3;
 527             vnet_hw_interface_t *hi0, *hi1, *hi2, *hi3;
 528
 529             /* Prefetch next iteration. */
 530             vlib_prefetch_buffer_header (b[4], LOAD);
 531             vlib_prefetch_buffer_header (b[5], LOAD);
 532             vlib_prefetch_buffer_header (b[6], LOAD);
 533             vlib_prefetch_buffer_header (b[7], LOAD);
 534
 535             bi0 = from[0];
 536             bi1 = from[1];
 537             bi2 = from[2];
 538             bi3 = from[3];
 539             to_next[0] = bi0;
 540             to_next[1] = bi1;
 541             to_next[2] = bi2;
 542             to_next[3] = bi3;
 543
 544             swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
 545             swif1 = vnet_buffer (b[1])->sw_if_index[VLIB_TX];
 546             swif2 = vnet_buffer (b[2])->sw_if_index[VLIB_TX];
 547             swif3 = vnet_buffer (b[3])->sw_if_index[VLIB_TX];
 548
 549             if (PREDICT_FALSE (hi->sw_if_index != swif0))
 550               {
 551                 hi0 = vnet_get_sup_hw_interface (vnm, swif0);
 552                 if ((hi0->caps & VNET_HW_INTERFACE_CAP_SUPPORTS_TCP_GSO) ==
 553                       0 &&
 554                     (b[0]->flags & VNET_BUFFER_F_GSO))
 555                   break;
 556               }
 557             if (PREDICT_FALSE (hi->sw_if_index != swif1))
 558               {
 559                 hi1 = vnet_get_sup_hw_interface (vnm, swif1);
 560                 if (!(hi1->caps & VNET_HW_INTERFACE_CAP_SUPPORTS_TCP_GSO) &&
 561                     (b[1]->flags & VNET_BUFFER_F_GSO))
 562                   break;
 563               }
 564             if (PREDICT_FALSE (hi->sw_if_index != swif2))
 565               {
 566                 hi2 = vnet_get_sup_hw_interface (vnm, swif2);
 567                 if ((hi2->caps & VNET_HW_INTERFACE_CAP_SUPPORTS_TCP_GSO) ==
 568                       0 &&
 569                     (b[2]->flags & VNET_BUFFER_F_GSO))
 570                   break;
 571               }
 572             if (PREDICT_FALSE (hi->sw_if_index != swif3))
 573               {
 574                 hi3 = vnet_get_sup_hw_interface (vnm, swif3);
 575                 if (!(hi3->caps & VNET_HW_INTERFACE_CAP_SUPPORTS_TCP_GSO) &&
 576                     (b[3]->flags & VNET_BUFFER_F_GSO))
 577                   break;
 578               }
 579
 580             if (b[0]->flags & VLIB_BUFFER_IS_TRACED)
 581               {
 582                 t0 = vlib_add_trace (vm, node, b[0], sizeof (t0[0]));
 583                 t0->flags = b[0]->flags & VNET_BUFFER_F_GSO;
 584                 t0->gso_size = vnet_buffer2 (b[0])->gso_size;
 585                 t0->gso_l4_hdr_sz = vnet_buffer2 (b[0])->gso_l4_hdr_sz;
 586                 vnet_generic_header_offset_parser (b[0], &t0->gho, is_l2,
 587                                                    is_ip4, is_ip6);
 588               }
 589             if (b[1]->flags & VLIB_BUFFER_IS_TRACED)
 590               {
 591                 t1 = vlib_add_trace (vm, node, b[1], sizeof (t1[0]));
 592                 t1->flags = b[1]->flags & VNET_BUFFER_F_GSO;
 593                 t1->gso_size = vnet_buffer2 (b[1])->gso_size;
 594                 t1->gso_l4_hdr_sz = vnet_buffer2 (b[1])->gso_l4_hdr_sz;
 595                 vnet_generic_header_offset_parser (b[1], &t1->gho, is_l2,
 596                                                    is_ip4, is_ip6);
 597               }
 598             if (b[2]->flags & VLIB_BUFFER_IS_TRACED)
 599               {
 600                 t2 = vlib_add_trace (vm, node, b[2], sizeof (t2[0]));
 601                 t2->flags = b[2]->flags & VNET_BUFFER_F_GSO;
 602                 t2->gso_size = vnet_buffer2 (b[2])->gso_size;
 603                 t2->gso_l4_hdr_sz = vnet_buffer2 (b[2])->gso_l4_hdr_sz;
 604                 vnet_generic_header_offset_parser (b[2], &t2->gho, is_l2,
 605                                                    is_ip4, is_ip6);
 606               }
 607             if (b[3]->flags & VLIB_BUFFER_IS_TRACED)
 608               {
 609                 t3 = vlib_add_trace (vm, node, b[3], sizeof (t3[0]));
 610                 t3->flags = b[3]->flags & VNET_BUFFER_F_GSO;
 611                 t3->gso_size = vnet_buffer2 (b[3])->gso_size;
 612                 t3->gso_l4_hdr_sz = vnet_buffer2 (b[3])->gso_l4_hdr_sz;
 613                 vnet_generic_header_offset_parser (b[3], &t3->gho, is_l2,
 614                                                    is_ip4, is_ip6);
 615               }
 616
 617             from += 4;
 618             to_next += 4;
 619             n_left_to_next -= 4;
 620             n_left_from -= 4;
 621
 622             next0 = next1 = 0;
 623             next2 = next3 = 0;
 624             vnet_feature_next (&next0, b[0]);
 625             vnet_feature_next (&next1, b[1]);
 626             vnet_feature_next (&next2, b[2]);
 627             vnet_feature_next (&next3, b[3]);
 628             vlib_validate_buffer_enqueue_x4 (vm, node, next_index, to_next,
 629                                              n_left_to_next, bi0, bi1, bi2,
 630                                              bi3, next0, next1, next2, next3);
 631             b += 4;
 632           }
 633
 634       while (from + 1 <= from_end && n_left_to_next > 0)
 635         {
 636           u32 bi0, swif0;
 637           gso_trace_t *t0;
 638           vnet_hw_interface_t *hi0;
 639           u32 next0 = 0;
 640           u32 do_segmentation0 = 0;
 641
 642           swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
 643           if (PREDICT_FALSE (hi->sw_if_index != swif0))
 644             {
 645               hi0 = vnet_get_sup_hw_interface (vnm, swif0);
 646               if ((hi0->caps & VNET_HW_INTERFACE_CAP_SUPPORTS_TCP_GSO) == 0 &&
 647                   (b[0]->flags & VNET_BUFFER_F_GSO))
 648                 do_segmentation0 = 1;
 649             }
 650           else
 651             do_segmentation0 = do_segmentation;
 652
 653           /* speculatively enqueue b0 to the current next frame */
 654           to_next[0] = bi0 = from[0];
 655           to_next += 1;
 656           n_left_to_next -= 1;
 657           from += 1;
 658           n_left_from -= 1;
 659
 660           if (b[0]->flags & VLIB_BUFFER_IS_TRACED)
 661             {
 662               t0 = vlib_add_trace (vm, node, b[0], sizeof (t0[0]));
 663               t0->flags = b[0]->flags & VNET_BUFFER_F_GSO;
 664               t0->gso_size = vnet_buffer2 (b[0])->gso_size;
 665               t0->gso_l4_hdr_sz = vnet_buffer2 (b[0])->gso_l4_hdr_sz;
 666               vnet_generic_header_offset_parser (b[0], &t0->gho, is_l2,
 667                                                  is_ip4, is_ip6);
 668             }
 669
 670           if (do_segmentation0)
 671             {
 672               if (PREDICT_FALSE (b[0]->flags & VNET_BUFFER_F_GSO))
 673                 {
 674                   /*
 675                    * Undo the enqueue of the b0 - it is not going anywhere,
 676                    * and will be freed either after it's segmented or
 677                    * when dropped, if there is no buffers to segment into.
 678                    */
 679                   to_next -= 1;
 680                   n_left_to_next += 1;
 681                   /* undo the counting. */
 682                   generic_header_offset_t gho = { 0 };
 683                   u32 n_tx_bytes = 0;
 684                   u32 inner_is_ip6 = is_ip6;
 685
 686                   vnet_generic_header_offset_parser (b[0], &gho, is_l2,
 687                                                      is_ip4, is_ip6);
 688
 689                   if (PREDICT_FALSE (gho.gho_flags & GHO_F_TUNNEL))
 690                     {
 691                       if (PREDICT_FALSE
 692                           (gho.gho_flags & (GHO_F_GRE_TUNNEL |
 693                                             GHO_F_GENEVE_TUNNEL)))
 694                         {
 695                           /* not supported yet */
 696                           drop_one_buffer_and_count (vm, vnm, node, from - 1,
 697                                                      hi->sw_if_index,
 698                                                      GSO_ERROR_UNHANDLED_TYPE);
 699                           b += 1;
 700                           continue;
 701                         }
 702
 703                       inner_is_ip6 = (gho.gho_flags & GHO_F_IP6) != 0;
 704                     }
 705
 706                   n_tx_bytes = gso_segment_buffer_inline (vm, ptd, b[0], &gho,
 707                                                           is_l2, inner_is_ip6);
 708
 709                   if (PREDICT_FALSE (n_tx_bytes == 0))
 710                     {
 711                       drop_one_buffer_and_count (vm, vnm, node, from - 1,
 712                                                  hi->sw_if_index,
 713                                                  GSO_ERROR_NO_BUFFERS);
 714                       b += 1;
 715                       continue;
 716                     }
 717
 718
 719                   if (PREDICT_FALSE (gho.gho_flags & GHO_F_VXLAN_TUNNEL))
 720                     {
 721                       n_tx_bytes +=
 722                         tso_segment_vxlan_tunnel_fixup (vm, ptd, b[0], &gho);
 723                     }
 724                   else
 725                     if (PREDICT_FALSE
 726                         (gho.gho_flags & (GHO_F_IPIP_TUNNEL |
 727                                           GHO_F_IPIP6_TUNNEL)))
 728                     {
 729                       n_tx_bytes +=
 730                         tso_segment_ipip_tunnel_fixup (vm, ptd, b[0], &gho);
 731                     }
 732
 733                   u16 n_tx_bufs = vec_len (ptd->split_buffers);
 734                   u32 *from_seg = ptd->split_buffers;
 735
 736                   while (n_tx_bufs > 0)
 737                     {
 738                       u32 sbi0;
 739                       vlib_buffer_t *sb0;
 740                       while (n_tx_bufs > 0 && n_left_to_next > 0)
 741                         {
 742                           sbi0 = to_next[0] = from_seg[0];
 743                           sb0 = vlib_get_buffer (vm, sbi0);
 744                           ASSERT (sb0->current_length > 0);
 745                           to_next += 1;
 746                           from_seg += 1;
 747                           n_left_to_next -= 1;
 748                           n_tx_bufs -= 1;
 749                           next0 = 0;
 750                           vnet_feature_next (&next0, sb0);
 751                           vlib_validate_buffer_enqueue_x1 (vm, node,
 752                                                            next_index,
 753                                                            to_next,
 754                                                            n_left_to_next,
 755                                                            sbi0, next0);
 756                         }
 757                       vlib_put_next_frame (vm, node, next_index,
 758                                            n_left_to_next);
 759                       if (n_tx_bufs > 0)
 760                         vlib_get_next_frame (vm, node, next_index,
 761                                              to_next, n_left_to_next);
 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           vnet_feature_next (&next0, b[0]);
 773           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
 774                                            n_left_to_next, bi0, next0);
 775           b += 1;
 776         }
 777       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
 778     }
 779
 780   return frame->n_vectors;
 781 }
 782
 783 static_always_inline uword
 784 vnet_gso_inline (vlib_main_t * vm,
 785                  vlib_node_runtime_t * node, vlib_frame_t * frame, int is_l2,
 786                  int is_ip4, int is_ip6)
 787 {
 788   vnet_main_t *vnm = vnet_get_main ();
 789   vnet_hw_interface_t *hi;
 790
 791   if (frame->n_vectors > 0)
 792     {
 793       u32 *from = vlib_frame_vector_args (frame);
 794       vlib_buffer_t *b = vlib_get_buffer (vm, from[0]);
 795       hi = vnet_get_sup_hw_interface (vnm,
 796                                       vnet_buffer (b)->sw_if_index[VLIB_TX]);
 797
 798       if (hi->caps & (VNET_HW_INTERFACE_CAP_SUPPORTS_TCP_GSO |
 799                       VNET_HW_INTERFACE_CAP_SUPPORTS_VXLAN_TNL_GSO))
 800         return vnet_gso_node_inline (vm, node, frame, vnm, hi,
 801                                      is_l2, is_ip4, is_ip6,
 802                                      /* do_segmentation */ 0);
 803       else
 804         return vnet_gso_node_inline (vm, node, frame, vnm, hi,
 805                                      is_l2, is_ip4, is_ip6,
 806                                      /* do_segmentation */ 1);
 807     }
 808   return 0;
 809 }
 810
 811 VLIB_NODE_FN (gso_l2_ip4_node) (vlib_main_t * vm, vlib_node_runtime_t * node,
 812                                 vlib_frame_t * frame)
 813 {
 814   return vnet_gso_inline (vm, node, frame, 1 /* l2 */ , 1 /* ip4 */ ,
 815                           0 /* ip6 */ );
 816 }
 817
 818 VLIB_NODE_FN (gso_l2_ip6_node) (vlib_main_t * vm, vlib_node_runtime_t * node,
 819                                 vlib_frame_t * frame)
 820 {
 821   return vnet_gso_inline (vm, node, frame, 1 /* l2 */ , 0 /* ip4 */ ,
 822                           1 /* ip6 */ );
 823 }
 824
 825 VLIB_NODE_FN (gso_ip4_node) (vlib_main_t * vm, vlib_node_runtime_t * node,
 826                              vlib_frame_t * frame)
 827 {
 828   return vnet_gso_inline (vm, node, frame, 0 /* l2 */ , 1 /* ip4 */ ,
 829                           0 /* ip6 */ );
 830 }
 831
 832 VLIB_NODE_FN (gso_ip6_node) (vlib_main_t * vm, vlib_node_runtime_t * node,
 833                              vlib_frame_t * frame)
 834 {
 835   return vnet_gso_inline (vm, node, frame, 0 /* l2 */ , 0 /* ip4 */ ,
 836                           1 /* ip6 */ );
 837 }
 838
 839 /* *INDENT-OFF* */
 840
 841 VLIB_REGISTER_NODE (gso_l2_ip4_node) = {
 842   .vector_size = sizeof (u32),
 843   .format_trace = format_gso_trace,
 844   .type = VLIB_NODE_TYPE_INTERNAL,
 845   .n_errors = ARRAY_LEN(gso_error_strings),
 846   .error_strings = gso_error_strings,
 847   .n_next_nodes = GSO_N_NEXT,
 848   .next_nodes = {
 849         [GSO_NEXT_DROP] = "error-drop",
 850   },
 851   .name = "gso-l2-ip4",
 852 };
 853
 854 VLIB_REGISTER_NODE (gso_l2_ip6_node) = {
 855   .vector_size = sizeof (u32),
 856   .format_trace = format_gso_trace,
 857   .type = VLIB_NODE_TYPE_INTERNAL,
 858   .n_errors = ARRAY_LEN(gso_error_strings),
 859   .error_strings = gso_error_strings,
 860   .n_next_nodes = GSO_N_NEXT,
 861   .next_nodes = {
 862         [GSO_NEXT_DROP] = "error-drop",
 863   },
 864   .name = "gso-l2-ip6",
 865 };
 866
 867 VLIB_REGISTER_NODE (gso_ip4_node) = {
 868   .vector_size = sizeof (u32),
 869   .format_trace = format_gso_trace,
 870   .type = VLIB_NODE_TYPE_INTERNAL,
 871   .n_errors = ARRAY_LEN(gso_error_strings),
 872   .error_strings = gso_error_strings,
 873   .n_next_nodes = GSO_N_NEXT,
 874   .next_nodes = {
 875         [GSO_NEXT_DROP] = "error-drop",
 876   },
 877   .name = "gso-ip4",
 878 };
 879
 880 VLIB_REGISTER_NODE (gso_ip6_node) = {
 881   .vector_size = sizeof (u32),
 882   .format_trace = format_gso_trace,
 883   .type = VLIB_NODE_TYPE_INTERNAL,
 884   .n_errors = ARRAY_LEN(gso_error_strings),
 885   .error_strings = gso_error_strings,
 886   .n_next_nodes = GSO_N_NEXT,
 887   .next_nodes = {
 888         [GSO_NEXT_DROP] = "error-drop",
 889   },
 890   .name = "gso-ip6",
 891 };
 892
 893 VNET_FEATURE_INIT (gso_l2_ip4_node, static) = {
 894   .arc_name = "l2-output-ip4",
 895   .node_name = "gso-l2-ip4",
 896   .runs_before = VNET_FEATURES ("l2-output-feat-arc-end"),
 897 };
 898
 899 VNET_FEATURE_INIT (gso_l2_ip6_node, static) = {
 900   .arc_name = "l2-output-ip6",
 901   .node_name = "gso-l2-ip6",
 902   .runs_before = VNET_FEATURES ("l2-output-feat-arc-end"),
 903 };
 904
 905 VNET_FEATURE_INIT (gso_ip4_node, static) = {
 906   .arc_name = "ip4-output",
 907   .node_name = "gso-ip4",
 908   .runs_before = VNET_FEATURES ("ipsec4-output-feature"),
 909 };
 910
 911 VNET_FEATURE_INIT (gso_ip6_node, static) = {
 912   .arc_name = "ip6-output",
 913   .node_name = "gso-ip6",
 914   .runs_before = VNET_FEATURES ("ipsec6-output-feature"),
 915 };
 916
 917 /*
 918  * fd.io coding-style-patch-verification: ON
 919  *
 920  * Local Variables:
 921  * eval: (c-set-style "gnu")
 922  * End:
 923  */