ikev2: add support for custom ipsec-over-udp port
[vpp.git] / src / vnet / gso / node.c
index 0690161..b3125fe 100644 (file)
@@ -43,6 +43,10 @@ format_gso_trace (u8 * s, va_list * args)
       s = format (s, "gso_sz %d gso_l4_hdr_sz %d",
                  t->gso_size, t->gso_l4_hdr_sz);
     }
+  else
+    {
+      s = format (s, "non-gso buffer");
+    }
 
   return s;
 }
@@ -51,10 +55,11 @@ static_always_inline u16
 tso_alloc_tx_bufs (vlib_main_t * vm,
                   vnet_interface_per_thread_data_t * ptd,
                   vlib_buffer_t * b0, u32 n_bytes_b0, u16 l234_sz,
-                  u16 gso_size)
+                  u16 gso_size, gso_header_offset_t * gho)
 {
   u16 size =
-    clib_min (gso_size, vlib_buffer_get_default_data_size (vm) - l234_sz);
+    clib_min (gso_size, vlib_buffer_get_default_data_size (vm) - l234_sz
+             - gho->l2_hdr_offset);
 
   /* rounded-up division */
   u16 n_bufs = (n_bytes_b0 - l234_sz + (size - 1)) / size;
@@ -90,7 +95,8 @@ static_always_inline void
 tso_init_buf_from_template (vlib_main_t * vm, vlib_buffer_t * nb0,
                            vlib_buffer_t * b0, u16 template_data_sz,
                            u16 gso_size, u8 ** p_dst_ptr, u16 * p_dst_left,
-                           u32 next_tcp_seq, u32 flags)
+                           u32 next_tcp_seq, u32 flags,
+                           gso_header_offset_t * gho)
 {
   tso_init_buf_from_template_base (nb0, b0, flags, template_data_sz);
 
@@ -101,29 +107,31 @@ tso_init_buf_from_template (vlib_main_t * vm, vlib_buffer_t * nb0,
   *p_dst_ptr = vlib_buffer_get_current (nb0) + template_data_sz;
 
   tcp_header_t *tcp =
-    (tcp_header_t *) (nb0->data + vnet_buffer (nb0)->l4_hdr_offset);
+    (tcp_header_t *) (vlib_buffer_get_current (nb0) + gho->l4_hdr_offset);
   tcp->seq_number = clib_host_to_net_u32 (next_tcp_seq);
 }
 
 static_always_inline void
-tso_fixup_segmented_buf (vlib_buffer_t * b0, u8 tcp_flags, int is_ip6)
+tso_fixup_segmented_buf (vlib_buffer_t * b0, u8 tcp_flags, int is_ip6,
+                        gso_header_offset_t * gho)
 {
-  u16 l3_hdr_offset = vnet_buffer (b0)->l3_hdr_offset;
-  u16 l4_hdr_offset = vnet_buffer (b0)->l4_hdr_offset;
-  ip4_header_t *ip4 = (ip4_header_t *) (b0->data + l3_hdr_offset);
-  ip6_header_t *ip6 = (ip6_header_t *) (b0->data + l3_hdr_offset);
-  tcp_header_t *tcp = (tcp_header_t *) (b0->data + l4_hdr_offset);
+  ip4_header_t *ip4 =
+    (ip4_header_t *) (vlib_buffer_get_current (b0) + gho->l3_hdr_offset);
+  ip6_header_t *ip6 =
+    (ip6_header_t *) (vlib_buffer_get_current (b0) + gho->l3_hdr_offset);
+  tcp_header_t *tcp =
+    (tcp_header_t *) (vlib_buffer_get_current (b0) + gho->l4_hdr_offset);
 
   tcp->flags = tcp_flags;
 
   if (is_ip6)
     ip6->payload_length =
       clib_host_to_net_u16 (b0->current_length -
-                           (l4_hdr_offset - b0->current_data));
+                           (gho->l4_hdr_offset - gho->l2_hdr_offset));
   else
     ip4->length =
       clib_host_to_net_u16 (b0->current_length -
-                           (l3_hdr_offset - b0->current_data));
+                           (gho->l3_hdr_offset - gho->l2_hdr_offset));
 }
 
 /**
@@ -137,21 +145,19 @@ tso_fixup_segmented_buf (vlib_buffer_t * b0, u8 tcp_flags, int is_ip6)
 
 static_always_inline u32
 tso_segment_buffer (vlib_main_t * vm, vnet_interface_per_thread_data_t * ptd,
-                   u32 sbi0, vlib_buffer_t * sb0, u32 n_bytes_b0, int is_ip6)
+                   u32 sbi0, vlib_buffer_t * sb0, gso_header_offset_t * gho,
+                   u32 n_bytes_b0, int is_ip6)
 {
   u32 n_tx_bytes = 0;
-  ASSERT (sb0->flags & VNET_BUFFER_F_L2_HDR_OFFSET_VALID);
-  ASSERT (sb0->flags & VNET_BUFFER_F_L3_HDR_OFFSET_VALID);
-  ASSERT (sb0->flags & VNET_BUFFER_F_L4_HDR_OFFSET_VALID);
   u16 gso_size = vnet_buffer2 (sb0)->gso_size;
 
-  int l4_hdr_sz = vnet_buffer2 (sb0)->gso_l4_hdr_sz;
+  int l4_hdr_sz = gho->l4_hdr_sz;
   u8 save_tcp_flags = 0;
   u8 tcp_flags_no_fin_psh = 0;
   u32 next_tcp_seq = 0;
 
   tcp_header_t *tcp =
-    (tcp_header_t *) (sb0->data + vnet_buffer (sb0)->l4_hdr_offset);
+    (tcp_header_t *) (vlib_buffer_get_current (sb0) + gho->l4_hdr_offset);
   next_tcp_seq = clib_net_to_host_u32 (tcp->seq_number);
   /* store original flags for last packet and reset FIN and PSH */
   save_tcp_flags = tcp->flags;
@@ -160,13 +166,12 @@ tso_segment_buffer (vlib_main_t * vm, vnet_interface_per_thread_data_t * ptd,
 
   u32 default_bflags =
     sb0->flags & ~(VNET_BUFFER_F_GSO | VLIB_BUFFER_NEXT_PRESENT);
-  u16 l234_sz = vnet_buffer (sb0)->l4_hdr_offset + l4_hdr_sz
-    - sb0->current_data;
+  u16 l234_sz = gho->l4_hdr_offset + l4_hdr_sz - gho->l2_hdr_offset;
   int first_data_size = clib_min (gso_size, sb0->current_length - l234_sz);
   next_tcp_seq += first_data_size;
 
   if (PREDICT_FALSE
-      (!tso_alloc_tx_bufs (vm, ptd, sb0, n_bytes_b0, l234_sz, gso_size)))
+      (!tso_alloc_tx_bufs (vm, ptd, sb0, n_bytes_b0, l234_sz, gso_size, gho)))
     return 0;
 
   vlib_buffer_t *b0 = vlib_get_buffer (vm, ptd->split_buffers[0]);
@@ -189,13 +194,14 @@ tso_segment_buffer (vlib_main_t * vm, vnet_interface_per_thread_data_t * ptd,
       src_ptr = vlib_buffer_get_current (sb0) + l234_sz + first_data_size;
       src_left = sb0->current_length - l234_sz - first_data_size;
 
-      tso_fixup_segmented_buf (b0, tcp_flags_no_fin_psh, is_ip6);
+      tso_fixup_segmented_buf (b0, tcp_flags_no_fin_psh, is_ip6, gho);
 
       /* grab a second buffer and prepare the loop */
       ASSERT (dbi < vec_len (ptd->split_buffers));
       cdb0 = vlib_get_buffer (vm, ptd->split_buffers[dbi++]);
       tso_init_buf_from_template (vm, cdb0, b0, l234_sz, gso_size, &dst_ptr,
-                                 &dst_left, next_tcp_seq, default_bflags);
+                                 &dst_left, next_tcp_seq, default_bflags,
+                                 gho);
 
       /* an arbitrary large number to catch the runaway loops */
       int nloops = 2000;
@@ -237,15 +243,17 @@ tso_segment_buffer (vlib_main_t * vm, vnet_interface_per_thread_data_t * ptd,
          if (0 == dst_left && total_src_left)
            {
              n_tx_bytes += cdb0->current_length;
+             tso_fixup_segmented_buf (cdb0, tcp_flags_no_fin_psh, is_ip6,
+                                      gho);
              ASSERT (dbi < vec_len (ptd->split_buffers));
              cdb0 = vlib_get_buffer (vm, ptd->split_buffers[dbi++]);
              tso_init_buf_from_template (vm, cdb0, b0, l234_sz,
                                          gso_size, &dst_ptr, &dst_left,
-                                         next_tcp_seq, default_bflags);
+                                         next_tcp_seq, default_bflags, gho);
            }
        }
 
-      tso_fixup_segmented_buf (cdb0, save_tcp_flags, is_ip6);
+      tso_fixup_segmented_buf (cdb0, save_tcp_flags, is_ip6, gho);
 
       n_tx_bytes += cdb0->current_length;
     }
@@ -300,108 +308,109 @@ vnet_gso_node_inline (vlib_main_t * vm,
 
       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
 
-      while (from + 8 <= from_end && n_left_to_next >= 4)
-       {
-         u32 bi0, bi1, bi2, bi3;
-         u32 next0, next1, next2, next3;
-         u32 swif0, swif1, swif2, swif3;
-         gso_trace_t *t0, *t1, *t2, *t3;
-         vnet_hw_interface_t *hi0, *hi1, *hi2, *hi3;
-
-         /* Prefetch next iteration. */
-         vlib_prefetch_buffer_header (b[4], LOAD);
-         vlib_prefetch_buffer_header (b[5], LOAD);
-         vlib_prefetch_buffer_header (b[6], LOAD);
-         vlib_prefetch_buffer_header (b[7], LOAD);
-
-         bi0 = from[0];
-         bi1 = from[1];
-         bi2 = from[2];
-         bi3 = from[3];
-         to_next[0] = bi0;
-         to_next[1] = bi1;
-         to_next[2] = bi2;
-         to_next[3] = bi3;
-
-         swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
-         swif1 = vnet_buffer (b[1])->sw_if_index[VLIB_TX];
-         swif2 = vnet_buffer (b[2])->sw_if_index[VLIB_TX];
-         swif3 = vnet_buffer (b[3])->sw_if_index[VLIB_TX];
-
-         if (PREDICT_FALSE (hi->sw_if_index != swif0))
-           {
-             hi0 = vnet_get_sup_hw_interface (vnm, swif0);
-             if ((hi0->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) == 0 &&
-                 (b[0]->flags & VNET_BUFFER_F_GSO))
-               break;
-           }
-         if (PREDICT_FALSE (hi->sw_if_index != swif1))
-           {
-             hi1 = vnet_get_sup_hw_interface (vnm, swif0);
-             if (!(hi1->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) &&
-                 (b[1]->flags & VNET_BUFFER_F_GSO))
-               break;
-           }
-         if (PREDICT_FALSE (hi->sw_if_index != swif2))
-           {
-             hi2 = vnet_get_sup_hw_interface (vnm, swif0);
-             if ((hi2->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) == 0 &&
-                 (b[2]->flags & VNET_BUFFER_F_GSO))
-               break;
-           }
-         if (PREDICT_FALSE (hi->sw_if_index != swif3))
-           {
-             hi3 = vnet_get_sup_hw_interface (vnm, swif0);
-             if (!(hi3->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) &&
-                 (b[3]->flags & VNET_BUFFER_F_GSO))
-               break;
-           }
-
-         if (b[0]->flags & VLIB_BUFFER_IS_TRACED)
-           {
-             t0 = vlib_add_trace (vm, node, b[0], sizeof (t0[0]));
-             t0->flags = b[0]->flags & VNET_BUFFER_F_GSO;
-             t0->gso_size = vnet_buffer2 (b[0])->gso_size;
-             t0->gso_l4_hdr_sz = vnet_buffer2 (b[0])->gso_l4_hdr_sz;
-           }
-         if (b[1]->flags & VLIB_BUFFER_IS_TRACED)
-           {
-             t1 = vlib_add_trace (vm, node, b[1], sizeof (t1[0]));
-             t1->flags = b[1]->flags & VNET_BUFFER_F_GSO;
-             t1->gso_size = vnet_buffer2 (b[1])->gso_size;
-             t1->gso_l4_hdr_sz = vnet_buffer2 (b[1])->gso_l4_hdr_sz;
-           }
-         if (b[2]->flags & VLIB_BUFFER_IS_TRACED)
-           {
-             t2 = vlib_add_trace (vm, node, b[2], sizeof (t2[0]));
-             t2->flags = b[2]->flags & VNET_BUFFER_F_GSO;
-             t2->gso_size = vnet_buffer2 (b[2])->gso_size;
-             t2->gso_l4_hdr_sz = vnet_buffer2 (b[2])->gso_l4_hdr_sz;
-           }
-         if (b[3]->flags & VLIB_BUFFER_IS_TRACED)
-           {
-             t3 = vlib_add_trace (vm, node, b[3], sizeof (t3[0]));
-             t3->flags = b[3]->flags & VNET_BUFFER_F_GSO;
-             t3->gso_size = vnet_buffer2 (b[3])->gso_size;
-             t3->gso_l4_hdr_sz = vnet_buffer2 (b[3])->gso_l4_hdr_sz;
-           }
-
-         from += 4;
-         to_next += 4;
-         n_left_to_next -= 4;
-         n_left_from -= 4;
-
-         next0 = next1 = 0;
-         next2 = next3 = 0;
-         vnet_feature_next (&next0, b[0]);
-         vnet_feature_next (&next1, b[1]);
-         vnet_feature_next (&next2, b[2]);
-         vnet_feature_next (&next3, b[3]);
-         vlib_validate_buffer_enqueue_x4 (vm, node, next_index, to_next,
-                                          n_left_to_next, bi0, bi1, bi2, bi3,
-                                          next0, next1, next2, next3);
-         b += 4;
-       }
+      if (!do_segmentation)
+       while (from + 8 <= from_end && n_left_to_next >= 4)
+         {
+           u32 bi0, bi1, bi2, bi3;
+           u32 next0, next1, next2, next3;
+           u32 swif0, swif1, swif2, swif3;
+           gso_trace_t *t0, *t1, *t2, *t3;
+           vnet_hw_interface_t *hi0, *hi1, *hi2, *hi3;
+
+           /* Prefetch next iteration. */
+           vlib_prefetch_buffer_header (b[4], LOAD);
+           vlib_prefetch_buffer_header (b[5], LOAD);
+           vlib_prefetch_buffer_header (b[6], LOAD);
+           vlib_prefetch_buffer_header (b[7], LOAD);
+
+           bi0 = from[0];
+           bi1 = from[1];
+           bi2 = from[2];
+           bi3 = from[3];
+           to_next[0] = bi0;
+           to_next[1] = bi1;
+           to_next[2] = bi2;
+           to_next[3] = bi3;
+
+           swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
+           swif1 = vnet_buffer (b[1])->sw_if_index[VLIB_TX];
+           swif2 = vnet_buffer (b[2])->sw_if_index[VLIB_TX];
+           swif3 = vnet_buffer (b[3])->sw_if_index[VLIB_TX];
+
+           if (PREDICT_FALSE (hi->sw_if_index != swif0))
+             {
+               hi0 = vnet_get_sup_hw_interface (vnm, swif0);
+               if ((hi0->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) == 0 &&
+                   (b[0]->flags & VNET_BUFFER_F_GSO))
+                 break;
+             }
+           if (PREDICT_FALSE (hi->sw_if_index != swif1))
+             {
+               hi1 = vnet_get_sup_hw_interface (vnm, swif1);
+               if (!(hi1->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) &&
+                   (b[1]->flags & VNET_BUFFER_F_GSO))
+                 break;
+             }
+           if (PREDICT_FALSE (hi->sw_if_index != swif2))
+             {
+               hi2 = vnet_get_sup_hw_interface (vnm, swif2);
+               if ((hi2->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) == 0 &&
+                   (b[2]->flags & VNET_BUFFER_F_GSO))
+                 break;
+             }
+           if (PREDICT_FALSE (hi->sw_if_index != swif3))
+             {
+               hi3 = vnet_get_sup_hw_interface (vnm, swif3);
+               if (!(hi3->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) &&
+                   (b[3]->flags & VNET_BUFFER_F_GSO))
+                 break;
+             }
+
+           if (b[0]->flags & VLIB_BUFFER_IS_TRACED)
+             {
+               t0 = vlib_add_trace (vm, node, b[0], sizeof (t0[0]));
+               t0->flags = b[0]->flags & VNET_BUFFER_F_GSO;
+               t0->gso_size = vnet_buffer2 (b[0])->gso_size;
+               t0->gso_l4_hdr_sz = vnet_buffer2 (b[0])->gso_l4_hdr_sz;
+             }
+           if (b[1]->flags & VLIB_BUFFER_IS_TRACED)
+             {
+               t1 = vlib_add_trace (vm, node, b[1], sizeof (t1[0]));
+               t1->flags = b[1]->flags & VNET_BUFFER_F_GSO;
+               t1->gso_size = vnet_buffer2 (b[1])->gso_size;
+               t1->gso_l4_hdr_sz = vnet_buffer2 (b[1])->gso_l4_hdr_sz;
+             }
+           if (b[2]->flags & VLIB_BUFFER_IS_TRACED)
+             {
+               t2 = vlib_add_trace (vm, node, b[2], sizeof (t2[0]));
+               t2->flags = b[2]->flags & VNET_BUFFER_F_GSO;
+               t2->gso_size = vnet_buffer2 (b[2])->gso_size;
+               t2->gso_l4_hdr_sz = vnet_buffer2 (b[2])->gso_l4_hdr_sz;
+             }
+           if (b[3]->flags & VLIB_BUFFER_IS_TRACED)
+             {
+               t3 = vlib_add_trace (vm, node, b[3], sizeof (t3[0]));
+               t3->flags = b[3]->flags & VNET_BUFFER_F_GSO;
+               t3->gso_size = vnet_buffer2 (b[3])->gso_size;
+               t3->gso_l4_hdr_sz = vnet_buffer2 (b[3])->gso_l4_hdr_sz;
+             }
+
+           from += 4;
+           to_next += 4;
+           n_left_to_next -= 4;
+           n_left_from -= 4;
+
+           next0 = next1 = 0;
+           next2 = next3 = 0;
+           vnet_feature_next (&next0, b[0]);
+           vnet_feature_next (&next1, b[1]);
+           vnet_feature_next (&next2, b[2]);
+           vnet_feature_next (&next3, b[3]);
+           vlib_validate_buffer_enqueue_x4 (vm, node, next_index, to_next,
+                                            n_left_to_next, bi0, bi1, bi2,
+                                            bi3, next0, next1, next2, next3);
+           b += 4;
+         }
 
       while (from + 1 <= from_end && n_left_to_next > 0)
        {
@@ -409,6 +418,7 @@ vnet_gso_node_inline (vlib_main_t * vm,
          gso_trace_t *t0;
          vnet_hw_interface_t *hi0;
          u32 next0 = 0;
+         u32 do_segmentation0 = 0;
 
          swif0 = vnet_buffer (b[0])->sw_if_index[VLIB_TX];
          if (PREDICT_FALSE (hi->sw_if_index != swif0))
@@ -416,8 +426,10 @@ vnet_gso_node_inline (vlib_main_t * vm,
              hi0 = vnet_get_sup_hw_interface (vnm, swif0);
              if ((hi0->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO) == 0 &&
                  (b[0]->flags & VNET_BUFFER_F_GSO))
-               do_segmentation = 1;
+               do_segmentation0 = 1;
            }
+         else
+           do_segmentation0 = do_segmentation;
 
          /* speculatively enqueue b0 to the current next frame */
          to_next[0] = bi0 = from[0];
@@ -434,7 +446,7 @@ vnet_gso_node_inline (vlib_main_t * vm,
              t0->gso_l4_hdr_sz = vnet_buffer2 (b[0])->gso_l4_hdr_sz;
            }
 
-         if (do_segmentation)
+         if (do_segmentation0)
            {
              if (PREDICT_FALSE (b[0]->flags & VNET_BUFFER_F_GSO))
                {
@@ -446,11 +458,13 @@ vnet_gso_node_inline (vlib_main_t * vm,
                  to_next -= 1;
                  n_left_to_next += 1;
                  /* undo the counting. */
+                 gso_header_offset_t gho;
                  u32 n_bytes_b0 = vlib_buffer_length_in_chain (vm, b[0]);
                  u32 n_tx_bytes = 0;
 
+                 gho = vnet_gso_header_offset_parser (b[0], is_ip6);
                  n_tx_bytes =
-                   tso_segment_buffer (vm, ptd, bi0, b[0], n_bytes_b0,
+                   tso_segment_buffer (vm, ptd, bi0, b[0], &gho, n_bytes_b0,
                                        is_ip6);
 
                  if (PREDICT_FALSE (n_tx_bytes == 0))
@@ -540,12 +554,7 @@ vnet_gso_inline (vlib_main_t * vm,
       vlib_buffer_t *b = vlib_get_buffer (vm, from[0]);
       hi = vnet_get_sup_hw_interface (vnm,
                                      vnet_buffer (b)->sw_if_index[VLIB_TX]);
-      /*
-       * The 3-headed "if" is here because we want to err on the side
-       * of not impacting the non-GSO performance - so for the more
-       * common case of no GSO interfaces we want to prevent the
-       * segmentation codepath from being there altogether.
-       */
+
       if (hi->flags & VNET_HW_INTERFACE_FLAG_SUPPORTS_GSO)
        return vnet_gso_node_inline (vm, node, frame, vnm, hi,
                                     is_ip6, /* do_segmentation */ 0);