src/vnet/tcp/tcp_output.c

   1 /*
   2  * Copyright (c) 2016 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 <vnet/tcp/tcp.h>
  17 #include <vnet/lisp-cp/packets.h>
  18 #include <math.h>
  19
  20 vlib_node_registration_t tcp4_output_node;
  21 vlib_node_registration_t tcp6_output_node;
  22
  23 typedef enum _tcp_output_next
  24 {
  25   TCP_OUTPUT_NEXT_DROP,
  26   TCP_OUTPUT_NEXT_IP_LOOKUP,
  27   TCP_OUTPUT_NEXT_IP_REWRITE,
  28   TCP_OUTPUT_NEXT_IP_ARP,
  29   TCP_OUTPUT_N_NEXT
  30 } tcp_output_next_t;
  31
  32 #define foreach_tcp4_output_next                \
  33   _ (DROP, "error-drop")                        \
  34   _ (IP_LOOKUP, "ip4-lookup")                   \
  35   _ (IP_REWRITE, "ip4-rewrite")                 \
  36   _ (IP_ARP, "ip4-arp")
  37
  38 #define foreach_tcp6_output_next                \
  39   _ (DROP, "error-drop")                        \
  40   _ (IP_LOOKUP, "ip6-lookup")                   \
  41   _ (IP_REWRITE, "ip6-rewrite")                 \
  42   _ (IP_ARP, "ip6-discover-neighbor")
  43
  44 static char *tcp_error_strings[] = {
  45 #define tcp_error(n,s) s,
  46 #include <vnet/tcp/tcp_error.def>
  47 #undef tcp_error
  48 };
  49
  50 typedef struct
  51 {
  52   tcp_header_t tcp_header;
  53   tcp_connection_t tcp_connection;
  54 } tcp_tx_trace_t;
  55
  56 u16 dummy_mtu = 1460;
  57
  58 u8 *
  59 format_tcp_tx_trace (u8 * s, va_list * args)
  60 {
  61   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
  62   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
  63   tcp_tx_trace_t *t = va_arg (*args, tcp_tx_trace_t *);
  64   u32 indent = format_get_indent (s);
  65
  66   s = format (s, "%U\n%U%U",
  67               format_tcp_header, &t->tcp_header, 128,
  68               format_white_space, indent,
  69               format_tcp_connection, &t->tcp_connection, 1);
  70
  71   return s;
  72 }
  73
  74 static u8
  75 tcp_window_compute_scale (u32 window)
  76 {
  77   u8 wnd_scale = 0;
  78   while (wnd_scale < TCP_MAX_WND_SCALE && (window >> wnd_scale) > TCP_WND_MAX)
  79     wnd_scale++;
  80   return wnd_scale;
  81 }
  82
  83 /**
  84  * Update max segment size we're able to process.
  85  *
  86  * The value is constrained by our interface's MTU and IP options. It is
  87  * also what we advertise to our peer.
  88  */
  89 void
  90 tcp_update_rcv_mss (tcp_connection_t * tc)
  91 {
  92   /* TODO find our iface MTU */
  93   tc->mss = dummy_mtu - sizeof (tcp_header_t);
  94 }
  95
  96 /**
  97  * TCP's initial window
  98  */
  99 always_inline u32
 100 tcp_initial_wnd_unscaled (tcp_connection_t * tc)
 101 {
 102   /* RFC 6928 recommends the value lower. However at the time our connections
 103    * are initialized, fifos may not be allocated. Therefore, advertise the
 104    * smallest possible unscaled window size and update once fifos are
 105    * assigned to the session.
 106    */
 107   /*
 108      tcp_update_rcv_mss (tc);
 109      TCP_IW_N_SEGMENTS * tc->mss;
 110    */
 111   return TCP_MIN_RX_FIFO_SIZE;
 112 }
 113
 114 /**
 115  * Compute initial window and scale factor. As per RFC1323, window field in
 116  * SYN and SYN-ACK segments is never scaled.
 117  */
 118 u32
 119 tcp_initial_window_to_advertise (tcp_connection_t * tc)
 120 {
 121   tcp_main_t *tm = &tcp_main;
 122   u32 max_fifo;
 123
 124   /* Initial wnd for SYN. Fifos are not allocated yet.
 125    * Use some predefined value. For SYN-ACK we still want the
 126    * scale to be computed in the same way */
 127   max_fifo = tm->max_rx_fifo ? tm->max_rx_fifo : TCP_MAX_RX_FIFO_SIZE;
 128
 129   /* Compute rcv wscale only if peer advertised support for it */
 130   if (tc->state != TCP_STATE_SYN_RCVD || tcp_opts_wscale (&tc->rcv_opts))
 131     tc->rcv_wscale = tcp_window_compute_scale (max_fifo);
 132
 133   tc->rcv_wnd = tcp_initial_wnd_unscaled (tc);
 134
 135   return clib_min (tc->rcv_wnd, TCP_WND_MAX);
 136 }
 137
 138 static void
 139 tcp_update_rcv_wnd (tcp_connection_t * tc)
 140 {
 141   i32 observed_wnd;
 142   u32 available_space, max_fifo, wnd;
 143
 144   /*
 145    * Figure out how much space we have available
 146    */
 147   available_space = transport_max_rx_enqueue (&tc->connection);
 148   max_fifo = transport_rx_fifo_size (&tc->connection);
 149
 150   ASSERT (tc->rcv_opts.mss < max_fifo);
 151   if (available_space < tc->rcv_opts.mss && available_space < max_fifo >> 3)
 152     available_space = 0;
 153
 154   /*
 155    * Use the above and what we know about what we've previously advertised
 156    * to compute the new window
 157    */
 158   observed_wnd = (i32) tc->rcv_wnd - (tc->rcv_nxt - tc->rcv_las);
 159   if (observed_wnd < 0)
 160     observed_wnd = 0;
 161
 162   /* Bad. Thou shalt not shrink */
 163   if (available_space < observed_wnd)
 164     {
 165       wnd = observed_wnd;
 166       TCP_EVT_DBG (TCP_EVT_RCV_WND_SHRUNK, tc, observed_wnd, available_space);
 167     }
 168   else
 169     {
 170       wnd = available_space;
 171     }
 172
 173   /* Make sure we have a multiple of rcv_wscale */
 174   if (wnd && tc->rcv_wscale)
 175     {
 176       wnd &= ~(1 << tc->rcv_wscale);
 177       if (wnd == 0)
 178         wnd = 1 << tc->rcv_wscale;
 179     }
 180
 181   tc->rcv_wnd = clib_min (wnd, TCP_WND_MAX << tc->rcv_wscale);
 182 }
 183
 184 /**
 185  * Compute and return window to advertise, scaled as per RFC1323
 186  */
 187 static u32
 188 tcp_window_to_advertise (tcp_connection_t * tc, tcp_state_t state)
 189 {
 190   if (state < TCP_STATE_ESTABLISHED)
 191     return tcp_initial_window_to_advertise (tc);
 192
 193   tcp_update_rcv_wnd (tc);
 194
 195   if (tc->rcv_wnd == 0)
 196     {
 197       tc->flags |= TCP_CONN_SENT_RCV_WND0;
 198     }
 199   else
 200     {
 201       tc->flags &= ~TCP_CONN_SENT_RCV_WND0;
 202     }
 203
 204   return tc->rcv_wnd >> tc->rcv_wscale;
 205 }
 206
 207 /**
 208  * Write TCP options to segment.
 209  */
 210 static u32
 211 tcp_options_write (u8 * data, tcp_options_t * opts)
 212 {
 213   u32 opts_len = 0;
 214   u32 buf, seq_len = 4;
 215
 216   if (tcp_opts_mss (opts))
 217     {
 218       *data++ = TCP_OPTION_MSS;
 219       *data++ = TCP_OPTION_LEN_MSS;
 220       buf = clib_host_to_net_u16 (opts->mss);
 221       clib_memcpy_fast (data, &buf, sizeof (opts->mss));
 222       data += sizeof (opts->mss);
 223       opts_len += TCP_OPTION_LEN_MSS;
 224     }
 225
 226   if (tcp_opts_wscale (opts))
 227     {
 228       *data++ = TCP_OPTION_WINDOW_SCALE;
 229       *data++ = TCP_OPTION_LEN_WINDOW_SCALE;
 230       *data++ = opts->wscale;
 231       opts_len += TCP_OPTION_LEN_WINDOW_SCALE;
 232     }
 233
 234   if (tcp_opts_sack_permitted (opts))
 235     {
 236       *data++ = TCP_OPTION_SACK_PERMITTED;
 237       *data++ = TCP_OPTION_LEN_SACK_PERMITTED;
 238       opts_len += TCP_OPTION_LEN_SACK_PERMITTED;
 239     }
 240
 241   if (tcp_opts_tstamp (opts))
 242     {
 243       *data++ = TCP_OPTION_TIMESTAMP;
 244       *data++ = TCP_OPTION_LEN_TIMESTAMP;
 245       buf = clib_host_to_net_u32 (opts->tsval);
 246       clib_memcpy_fast (data, &buf, sizeof (opts->tsval));
 247       data += sizeof (opts->tsval);
 248       buf = clib_host_to_net_u32 (opts->tsecr);
 249       clib_memcpy_fast (data, &buf, sizeof (opts->tsecr));
 250       data += sizeof (opts->tsecr);
 251       opts_len += TCP_OPTION_LEN_TIMESTAMP;
 252     }
 253
 254   if (tcp_opts_sack (opts))
 255     {
 256       int i;
 257       u32 n_sack_blocks = clib_min (vec_len (opts->sacks),
 258                                     TCP_OPTS_MAX_SACK_BLOCKS);
 259
 260       if (n_sack_blocks != 0)
 261         {
 262           *data++ = TCP_OPTION_SACK_BLOCK;
 263           *data++ = 2 + n_sack_blocks * TCP_OPTION_LEN_SACK_BLOCK;
 264           for (i = 0; i < n_sack_blocks; i++)
 265             {
 266               buf = clib_host_to_net_u32 (opts->sacks[i].start);
 267               clib_memcpy_fast (data, &buf, seq_len);
 268               data += seq_len;
 269               buf = clib_host_to_net_u32 (opts->sacks[i].end);
 270               clib_memcpy_fast (data, &buf, seq_len);
 271               data += seq_len;
 272             }
 273           opts_len += 2 + n_sack_blocks * TCP_OPTION_LEN_SACK_BLOCK;
 274         }
 275     }
 276
 277   /* Terminate TCP options */
 278   if (opts_len % 4)
 279     {
 280       *data++ = TCP_OPTION_EOL;
 281       opts_len += TCP_OPTION_LEN_EOL;
 282     }
 283
 284   /* Pad with zeroes to a u32 boundary */
 285   while (opts_len % 4)
 286     {
 287       *data++ = TCP_OPTION_NOOP;
 288       opts_len += TCP_OPTION_LEN_NOOP;
 289     }
 290   return opts_len;
 291 }
 292
 293 static int
 294 tcp_make_syn_options (tcp_options_t * opts, u8 wnd_scale)
 295 {
 296   u8 len = 0;
 297
 298   opts->flags |= TCP_OPTS_FLAG_MSS;
 299   opts->mss = dummy_mtu;        /*XXX discover that */
 300   len += TCP_OPTION_LEN_MSS;
 301
 302   opts->flags |= TCP_OPTS_FLAG_WSCALE;
 303   opts->wscale = wnd_scale;
 304   len += TCP_OPTION_LEN_WINDOW_SCALE;
 305
 306   opts->flags |= TCP_OPTS_FLAG_TSTAMP;
 307   opts->tsval = tcp_time_now ();
 308   opts->tsecr = 0;
 309   len += TCP_OPTION_LEN_TIMESTAMP;
 310
 311   if (TCP_USE_SACKS)
 312     {
 313       opts->flags |= TCP_OPTS_FLAG_SACK_PERMITTED;
 314       len += TCP_OPTION_LEN_SACK_PERMITTED;
 315     }
 316
 317   /* Align to needed boundary */
 318   len += (TCP_OPTS_ALIGN - len % TCP_OPTS_ALIGN) % TCP_OPTS_ALIGN;
 319   return len;
 320 }
 321
 322 static int
 323 tcp_make_synack_options (tcp_connection_t * tc, tcp_options_t * opts)
 324 {
 325   u8 len = 0;
 326
 327   opts->flags |= TCP_OPTS_FLAG_MSS;
 328   opts->mss = tc->mss;
 329   len += TCP_OPTION_LEN_MSS;
 330
 331   if (tcp_opts_wscale (&tc->rcv_opts))
 332     {
 333       opts->flags |= TCP_OPTS_FLAG_WSCALE;
 334       opts->wscale = tc->rcv_wscale;
 335       len += TCP_OPTION_LEN_WINDOW_SCALE;
 336     }
 337
 338   if (tcp_opts_tstamp (&tc->rcv_opts))
 339     {
 340       opts->flags |= TCP_OPTS_FLAG_TSTAMP;
 341       opts->tsval = tcp_time_now ();
 342       opts->tsecr = tc->tsval_recent;
 343       len += TCP_OPTION_LEN_TIMESTAMP;
 344     }
 345
 346   if (tcp_opts_sack_permitted (&tc->rcv_opts))
 347     {
 348       opts->flags |= TCP_OPTS_FLAG_SACK_PERMITTED;
 349       len += TCP_OPTION_LEN_SACK_PERMITTED;
 350     }
 351
 352   /* Align to needed boundary */
 353   len += (TCP_OPTS_ALIGN - len % TCP_OPTS_ALIGN) % TCP_OPTS_ALIGN;
 354   return len;
 355 }
 356
 357 static int
 358 tcp_make_established_options (tcp_connection_t * tc, tcp_options_t * opts)
 359 {
 360   u8 len = 0;
 361
 362   opts->flags = 0;
 363
 364   if (tcp_opts_tstamp (&tc->rcv_opts))
 365     {
 366       opts->flags |= TCP_OPTS_FLAG_TSTAMP;
 367       opts->tsval = tcp_time_now_w_thread (tc->c_thread_index);
 368       opts->tsecr = tc->tsval_recent;
 369       len += TCP_OPTION_LEN_TIMESTAMP;
 370     }
 371   if (tcp_opts_sack_permitted (&tc->rcv_opts))
 372     {
 373       if (vec_len (tc->snd_sacks))
 374         {
 375           opts->flags |= TCP_OPTS_FLAG_SACK;
 376           opts->sacks = tc->snd_sacks;
 377           opts->n_sack_blocks = clib_min (vec_len (tc->snd_sacks),
 378                                           TCP_OPTS_MAX_SACK_BLOCKS);
 379           len += 2 + TCP_OPTION_LEN_SACK_BLOCK * opts->n_sack_blocks;
 380         }
 381     }
 382
 383   /* Align to needed boundary */
 384   len += (TCP_OPTS_ALIGN - len % TCP_OPTS_ALIGN) % TCP_OPTS_ALIGN;
 385   return len;
 386 }
 387
 388 always_inline int
 389 tcp_make_options (tcp_connection_t * tc, tcp_options_t * opts,
 390                   tcp_state_t state)
 391 {
 392   switch (state)
 393     {
 394     case TCP_STATE_ESTABLISHED:
 395     case TCP_STATE_CLOSE_WAIT:
 396     case TCP_STATE_FIN_WAIT_1:
 397     case TCP_STATE_LAST_ACK:
 398     case TCP_STATE_CLOSING:
 399     case TCP_STATE_FIN_WAIT_2:
 400     case TCP_STATE_TIME_WAIT:
 401     case TCP_STATE_CLOSED:
 402       return tcp_make_established_options (tc, opts);
 403     case TCP_STATE_SYN_RCVD:
 404       return tcp_make_synack_options (tc, opts);
 405     case TCP_STATE_SYN_SENT:
 406       return tcp_make_syn_options (opts, tc->rcv_wscale);
 407     default:
 408       clib_warning ("State not handled! %d", state);
 409       return 0;
 410     }
 411 }
 412
 413 /**
 414  * Update burst send vars
 415  *
 416  * - Updates snd_mss to reflect the effective segment size that we can send
 417  * by taking into account all TCP options, including SACKs.
 418  * - Cache 'on the wire' options for reuse
 419  * - Updates receive window which can be reused for a burst.
 420  *
 421  * This should *only* be called when doing bursts
 422  */
 423 void
 424 tcp_update_burst_snd_vars (tcp_connection_t * tc)
 425 {
 426   tcp_main_t *tm = &tcp_main;
 427
 428   /* Compute options to be used for connection. These may be reused when
 429    * sending data or to compute the effective mss (snd_mss) */
 430   tc->snd_opts_len = tcp_make_options (tc, &tc->snd_opts,
 431                                        TCP_STATE_ESTABLISHED);
 432
 433   /* XXX check if MTU has been updated */
 434   tc->snd_mss = clib_min (tc->mss, tc->rcv_opts.mss) - tc->snd_opts_len;
 435   ASSERT (tc->snd_mss > 0);
 436
 437   tcp_options_write (tm->wrk_ctx[tc->c_thread_index].cached_opts,
 438                      &tc->snd_opts);
 439
 440   tcp_update_rcv_wnd (tc);
 441 }
 442
 443 void
 444 tcp_init_mss (tcp_connection_t * tc)
 445 {
 446   u16 default_min_mss = 536;
 447   tcp_update_rcv_mss (tc);
 448
 449   /* TODO cache mss and consider PMTU discovery */
 450   tc->snd_mss = clib_min (tc->rcv_opts.mss, tc->mss);
 451
 452   if (tc->snd_mss < 45)
 453     {
 454       /* Assume that at least the min default mss works */
 455       tc->snd_mss = default_min_mss;
 456       tc->rcv_opts.mss = default_min_mss;
 457     }
 458
 459   /* We should have enough space for 40 bytes of options */
 460   ASSERT (tc->snd_mss > 45);
 461
 462   /* If we use timestamp option, account for it */
 463   if (tcp_opts_tstamp (&tc->rcv_opts))
 464     tc->snd_mss -= TCP_OPTION_LEN_TIMESTAMP;
 465 }
 466
 467 static int
 468 tcp_alloc_tx_buffers (tcp_worker_ctx_t * wrk, u16 * n_bufs, u32 wanted)
 469 {
 470   vlib_main_t *vm = vlib_get_main ();
 471   u32 n_alloc;
 472
 473   ASSERT (wanted > *n_bufs);
 474   vec_validate_aligned (wrk->tx_buffers, wanted - 1, CLIB_CACHE_LINE_BYTES);
 475   n_alloc = vlib_buffer_alloc (vm, &wrk->tx_buffers[*n_bufs],
 476                                wanted - *n_bufs);
 477   *n_bufs += n_alloc;
 478   _vec_len (wrk->tx_buffers) = *n_bufs;
 479   return n_alloc;
 480 }
 481
 482 always_inline int
 483 tcp_get_free_buffer_index (tcp_worker_ctx_t * wrk, u32 * bidx)
 484 {
 485   u16 n_bufs = vec_len (wrk->tx_buffers);
 486
 487   TCP_DBG_BUFFER_ALLOC_MAYBE_FAIL (wrk->vm->thread_index);
 488
 489   if (PREDICT_FALSE (!n_bufs))
 490     {
 491       if (!tcp_alloc_tx_buffers (wrk, &n_bufs, VLIB_FRAME_SIZE))
 492         {
 493           *bidx = ~0;
 494           return -1;
 495         }
 496     }
 497   *bidx = wrk->tx_buffers[--n_bufs];
 498   _vec_len (wrk->tx_buffers) = n_bufs;
 499   return 0;
 500 }
 501
 502 static void *
 503 tcp_reuse_buffer (vlib_main_t * vm, vlib_buffer_t * b)
 504 {
 505   if (b->flags & VLIB_BUFFER_NEXT_PRESENT)
 506     vlib_buffer_free_one (vm, b->next_buffer);
 507   /* Zero all flags but free list index and trace flag */
 508   b->flags &= VLIB_BUFFER_NEXT_PRESENT - 1;
 509   b->current_data = 0;
 510   b->current_length = 0;
 511   b->total_length_not_including_first_buffer = 0;
 512   vnet_buffer (b)->tcp.flags = 0;
 513
 514   /* Leave enough space for headers */
 515   return vlib_buffer_make_headroom (b, MAX_HDRS_LEN);
 516 }
 517
 518 static void *
 519 tcp_init_buffer (vlib_main_t * vm, vlib_buffer_t * b)
 520 {
 521   ASSERT ((b->flags & VLIB_BUFFER_NEXT_PRESENT) == 0);
 522   b->flags &= VLIB_BUFFER_NON_DEFAULT_FREELIST;
 523   b->flags |= VNET_BUFFER_F_LOCALLY_ORIGINATED;
 524   b->total_length_not_including_first_buffer = 0;
 525   b->current_data = 0;
 526   vnet_buffer (b)->tcp.flags = 0;
 527   VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b);
 528   /* Leave enough space for headers */
 529   return vlib_buffer_make_headroom (b, MAX_HDRS_LEN);
 530 }
 531
 532 /**
 533  * Prepare ACK
 534  */
 535 static void
 536 tcp_make_ack_i (tcp_connection_t * tc, vlib_buffer_t * b, tcp_state_t state,
 537                 u8 flags)
 538 {
 539   tcp_options_t _snd_opts, *snd_opts = &_snd_opts;
 540   u8 tcp_opts_len, tcp_hdr_opts_len;
 541   tcp_header_t *th;
 542   u16 wnd;
 543
 544   wnd = tcp_window_to_advertise (tc, state);
 545
 546   /* Make and write options */
 547   tcp_opts_len = tcp_make_established_options (tc, snd_opts);
 548   tcp_hdr_opts_len = tcp_opts_len + sizeof (tcp_header_t);
 549
 550   th = vlib_buffer_push_tcp (b, tc->c_lcl_port, tc->c_rmt_port, tc->snd_nxt,
 551                              tc->rcv_nxt, tcp_hdr_opts_len, flags, wnd);
 552
 553   tcp_options_write ((u8 *) (th + 1), snd_opts);
 554   vnet_buffer (b)->tcp.connection_index = tc->c_c_index;
 555 }
 556
 557 /**
 558  * Convert buffer to ACK
 559  */
 560 void
 561 tcp_make_ack (tcp_connection_t * tc, vlib_buffer_t * b)
 562 {
 563   vlib_main_t *vm = vlib_get_main ();
 564
 565   tcp_reuse_buffer (vm, b);
 566   tcp_make_ack_i (tc, b, TCP_STATE_ESTABLISHED, TCP_FLAG_ACK);
 567   TCP_EVT_DBG (TCP_EVT_ACK_SENT, tc);
 568   tc->rcv_las = tc->rcv_nxt;
 569 }
 570
 571 /**
 572  * Convert buffer to FIN-ACK
 573  */
 574 void
 575 tcp_make_fin (tcp_connection_t * tc, vlib_buffer_t * b)
 576 {
 577   vlib_main_t *vm = vlib_get_main ();
 578   u8 flags = 0;
 579
 580   tcp_reuse_buffer (vm, b);
 581
 582   flags = TCP_FLAG_FIN | TCP_FLAG_ACK;
 583   tcp_make_ack_i (tc, b, TCP_STATE_ESTABLISHED, flags);
 584
 585   /* Reset flags, make sure ack is sent */
 586   vnet_buffer (b)->tcp.flags &= ~TCP_BUF_FLAG_DUPACK;
 587 }
 588
 589 /**
 590  * Convert buffer to SYN
 591  */
 592 void
 593 tcp_make_syn (tcp_connection_t * tc, vlib_buffer_t * b)
 594 {
 595   u8 tcp_hdr_opts_len, tcp_opts_len;
 596   tcp_header_t *th;
 597   u16 initial_wnd;
 598   tcp_options_t snd_opts;
 599
 600   initial_wnd = tcp_initial_window_to_advertise (tc);
 601
 602   /* Make and write options */
 603   clib_memset (&snd_opts, 0, sizeof (snd_opts));
 604   tcp_opts_len = tcp_make_syn_options (&snd_opts, tc->rcv_wscale);
 605   tcp_hdr_opts_len = tcp_opts_len + sizeof (tcp_header_t);
 606
 607   th = vlib_buffer_push_tcp (b, tc->c_lcl_port, tc->c_rmt_port, tc->iss,
 608                              tc->rcv_nxt, tcp_hdr_opts_len, TCP_FLAG_SYN,
 609                              initial_wnd);
 610   vnet_buffer (b)->tcp.connection_index = tc->c_c_index;
 611   tcp_options_write ((u8 *) (th + 1), &snd_opts);
 612 }
 613
 614 /**
 615  * Convert buffer to SYN-ACK
 616  */
 617 void
 618 tcp_make_synack (tcp_connection_t * tc, vlib_buffer_t * b)
 619 {
 620   vlib_main_t *vm = vlib_get_main ();
 621   tcp_options_t _snd_opts, *snd_opts = &_snd_opts;
 622   u8 tcp_opts_len, tcp_hdr_opts_len;
 623   tcp_header_t *th;
 624   u16 initial_wnd;
 625
 626   clib_memset (snd_opts, 0, sizeof (*snd_opts));
 627   tcp_reuse_buffer (vm, b);
 628
 629   initial_wnd = tcp_initial_window_to_advertise (tc);
 630   tcp_opts_len = tcp_make_synack_options (tc, snd_opts);
 631   tcp_hdr_opts_len = tcp_opts_len + sizeof (tcp_header_t);
 632
 633   th = vlib_buffer_push_tcp (b, tc->c_lcl_port, tc->c_rmt_port, tc->iss,
 634                              tc->rcv_nxt, tcp_hdr_opts_len,
 635                              TCP_FLAG_SYN | TCP_FLAG_ACK, initial_wnd);
 636   tcp_options_write ((u8 *) (th + 1), snd_opts);
 637
 638   vnet_buffer (b)->tcp.connection_index = tc->c_c_index;
 639
 640   /* Init retransmit timer. Use update instead of set because of
 641    * retransmissions */
 642   tcp_retransmit_timer_force_update (tc);
 643   TCP_EVT_DBG (TCP_EVT_SYNACK_SENT, tc);
 644 }
 645
 646 always_inline void
 647 tcp_enqueue_to_ip_lookup_i (tcp_worker_ctx_t * wrk, vlib_buffer_t * b, u32 bi,
 648                             u8 is_ip4, u32 fib_index, u8 flush)
 649 {
 650   vlib_main_t *vm = wrk->vm;
 651   u32 *to_next, next_index;
 652   vlib_frame_t *f;
 653
 654   b->flags |= VNET_BUFFER_F_LOCALLY_ORIGINATED;
 655   b->error = 0;
 656
 657   vnet_buffer (b)->sw_if_index[VLIB_TX] = fib_index;
 658   vnet_buffer (b)->sw_if_index[VLIB_RX] = 0;
 659
 660   /* Send to IP lookup */
 661   next_index = is_ip4 ? ip4_lookup_node.index : ip6_lookup_node.index;
 662   tcp_trajectory_add_start (b, 1);
 663
 664   f = wrk->ip_lookup_tx_frames[!is_ip4];
 665   if (!f)
 666     {
 667       f = vlib_get_frame_to_node (vm, next_index);
 668       ASSERT (f);
 669       wrk->ip_lookup_tx_frames[!is_ip4] = f;
 670     }
 671
 672   to_next = vlib_frame_vector_args (f);
 673   to_next[f->n_vectors] = bi;
 674   f->n_vectors += 1;
 675   if (flush || f->n_vectors == VLIB_FRAME_SIZE)
 676     {
 677       vlib_put_frame_to_node (vm, next_index, f);
 678       wrk->ip_lookup_tx_frames[!is_ip4] = 0;
 679     }
 680 }
 681
 682 static void
 683 tcp_enqueue_to_ip_lookup_now (tcp_worker_ctx_t * wrk, vlib_buffer_t * b,
 684                               u32 bi, u8 is_ip4, u32 fib_index)
 685 {
 686   tcp_enqueue_to_ip_lookup_i (wrk, b, bi, is_ip4, fib_index, 1);
 687 }
 688
 689 static void
 690 tcp_enqueue_to_ip_lookup (tcp_worker_ctx_t * wrk, vlib_buffer_t * b, u32 bi,
 691                           u8 is_ip4, u32 fib_index)
 692 {
 693   tcp_enqueue_to_ip_lookup_i (wrk, b, bi, is_ip4, fib_index, 0);
 694   if (wrk->vm->thread_index == 0 && vlib_num_workers ())
 695     session_flush_frames_main_thread (wrk->vm);
 696 }
 697
 698 always_inline void
 699 tcp_enqueue_to_output_i (tcp_worker_ctx_t * wrk, vlib_buffer_t * b, u32 bi,
 700                          u8 is_ip4, u8 flush)
 701 {
 702   u32 *to_next, next_index;
 703   vlib_frame_t *f;
 704
 705   b->flags |= VNET_BUFFER_F_LOCALLY_ORIGINATED;
 706   b->error = 0;
 707
 708   /* Decide where to send the packet */
 709   next_index = is_ip4 ? tcp4_output_node.index : tcp6_output_node.index;
 710   tcp_trajectory_add_start (b, 2);
 711
 712   /* Get frame to v4/6 output node */
 713   f = wrk->tx_frames[!is_ip4];
 714   if (!f)
 715     {
 716       f = vlib_get_frame_to_node (wrk->vm, next_index);
 717       ASSERT (f);
 718       wrk->tx_frames[!is_ip4] = f;
 719     }
 720   to_next = vlib_frame_vector_args (f);
 721   to_next[f->n_vectors] = bi;
 722   f->n_vectors += 1;
 723   if (flush || f->n_vectors == VLIB_FRAME_SIZE)
 724     {
 725       vlib_put_frame_to_node (wrk->vm, next_index, f);
 726       wrk->tx_frames[!is_ip4] = 0;
 727     }
 728 }
 729
 730 static void
 731 tcp_enqueue_to_output (tcp_worker_ctx_t * wrk, vlib_buffer_t * b, u32 bi,
 732                        u8 is_ip4)
 733 {
 734   tcp_enqueue_to_output_i (wrk, b, bi, is_ip4, 0);
 735 }
 736
 737 static void
 738 tcp_enqueue_to_output_now (tcp_worker_ctx_t * wrk, vlib_buffer_t * b, u32 bi,
 739                            u8 is_ip4)
 740 {
 741   tcp_enqueue_to_output_i (wrk, b, bi, is_ip4, 1);
 742 }
 743
 744 static int
 745 tcp_make_reset_in_place (vlib_main_t * vm, vlib_buffer_t * b0,
 746                          tcp_state_t state, u8 thread_index, u8 is_ip4)
 747 {
 748   ip4_header_t *ih4;
 749   ip6_header_t *ih6;
 750   tcp_header_t *th0;
 751   ip4_address_t src_ip40, dst_ip40;
 752   ip6_address_t src_ip60, dst_ip60;
 753   u16 src_port, dst_port;
 754   u32 tmp;
 755   u32 seq, ack;
 756   u8 flags;
 757
 758   /* Find IP and TCP headers */
 759   th0 = tcp_buffer_hdr (b0);
 760
 761   /* Save src and dst ip */
 762   if (is_ip4)
 763     {
 764       ih4 = vlib_buffer_get_current (b0);
 765       ASSERT ((ih4->ip_version_and_header_length & 0xF0) == 0x40);
 766       src_ip40.as_u32 = ih4->src_address.as_u32;
 767       dst_ip40.as_u32 = ih4->dst_address.as_u32;
 768     }
 769   else
 770     {
 771       ih6 = vlib_buffer_get_current (b0);
 772       ASSERT ((ih6->ip_version_traffic_class_and_flow_label & 0xF0) == 0x60);
 773       clib_memcpy_fast (&src_ip60, &ih6->src_address, sizeof (ip6_address_t));
 774       clib_memcpy_fast (&dst_ip60, &ih6->dst_address, sizeof (ip6_address_t));
 775     }
 776
 777   src_port = th0->src_port;
 778   dst_port = th0->dst_port;
 779
 780   /* Try to determine what/why we're actually resetting */
 781   if (state == TCP_STATE_CLOSED)
 782     {
 783       if (!tcp_syn (th0))
 784         return -1;
 785
 786       tmp = clib_net_to_host_u32 (th0->seq_number);
 787
 788       /* Got a SYN for no listener. */
 789       flags = TCP_FLAG_RST | TCP_FLAG_ACK;
 790       ack = clib_host_to_net_u32 (tmp + 1);
 791       seq = 0;
 792     }
 793   else
 794     {
 795       flags = TCP_FLAG_RST;
 796       seq = th0->ack_number;
 797       ack = 0;
 798     }
 799
 800   tcp_reuse_buffer (vm, b0);
 801   tcp_trajectory_add_start (b0, 4);
 802   th0 = vlib_buffer_push_tcp_net_order (b0, dst_port, src_port, seq, ack,
 803                                         sizeof (tcp_header_t), flags, 0);
 804
 805   if (is_ip4)
 806     {
 807       ih4 = vlib_buffer_push_ip4 (vm, b0, &dst_ip40, &src_ip40,
 808                                   IP_PROTOCOL_TCP, 1);
 809       th0->checksum = ip4_tcp_udp_compute_checksum (vm, b0, ih4);
 810     }
 811   else
 812     {
 813       int bogus = ~0;
 814       ih6 = vlib_buffer_push_ip6 (vm, b0, &dst_ip60, &src_ip60,
 815                                   IP_PROTOCOL_TCP);
 816       th0->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b0, ih6, &bogus);
 817       ASSERT (!bogus);
 818     }
 819
 820   return 0;
 821 }
 822
 823 /**
 824  *  Send reset without reusing existing buffer
 825  *
 826  *  It extracts connection info out of original packet
 827  */
 828 void
 829 tcp_send_reset_w_pkt (tcp_connection_t * tc, vlib_buffer_t * pkt, u8 is_ip4)
 830 {
 831   tcp_worker_ctx_t *wrk = tcp_get_worker (tc->c_thread_index);
 832   vlib_main_t *vm = wrk->vm;
 833   vlib_buffer_t *b;
 834   u32 bi, sw_if_index, fib_index;
 835   u8 tcp_hdr_len, flags = 0;
 836   tcp_header_t *th, *pkt_th;
 837   u32 seq, ack;
 838   ip4_header_t *ih4, *pkt_ih4;
 839   ip6_header_t *ih6, *pkt_ih6;
 840   fib_protocol_t fib_proto;
 841
 842   if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
 843     return;
 844
 845   b = vlib_get_buffer (vm, bi);
 846   sw_if_index = vnet_buffer (pkt)->sw_if_index[VLIB_RX];
 847   fib_proto = is_ip4 ? FIB_PROTOCOL_IP4 : FIB_PROTOCOL_IP6;
 848   fib_index = fib_table_get_index_for_sw_if_index (fib_proto, sw_if_index);
 849   tcp_init_buffer (vm, b);
 850
 851   /* Make and write options */
 852   tcp_hdr_len = sizeof (tcp_header_t);
 853
 854   if (is_ip4)
 855     {
 856       pkt_ih4 = vlib_buffer_get_current (pkt);
 857       pkt_th = ip4_next_header (pkt_ih4);
 858     }
 859   else
 860     {
 861       pkt_ih6 = vlib_buffer_get_current (pkt);
 862       pkt_th = ip6_next_header (pkt_ih6);
 863     }
 864
 865   if (tcp_ack (pkt_th))
 866     {
 867       flags = TCP_FLAG_RST;
 868       seq = pkt_th->ack_number;
 869       ack = (tc->state >= TCP_STATE_SYN_RCVD) ? tc->rcv_nxt : 0;
 870     }
 871   else
 872     {
 873       flags = TCP_FLAG_RST | TCP_FLAG_ACK;
 874       seq = 0;
 875       ack = clib_host_to_net_u32 (vnet_buffer (pkt)->tcp.seq_end);
 876     }
 877
 878   th = vlib_buffer_push_tcp_net_order (b, pkt_th->dst_port, pkt_th->src_port,
 879                                        seq, ack, tcp_hdr_len, flags, 0);
 880
 881   /* Swap src and dst ip */
 882   if (is_ip4)
 883     {
 884       ASSERT ((pkt_ih4->ip_version_and_header_length & 0xF0) == 0x40);
 885       ih4 = vlib_buffer_push_ip4 (vm, b, &pkt_ih4->dst_address,
 886                                   &pkt_ih4->src_address, IP_PROTOCOL_TCP, 1);
 887       th->checksum = ip4_tcp_udp_compute_checksum (vm, b, ih4);
 888     }
 889   else
 890     {
 891       int bogus = ~0;
 892       ASSERT ((pkt_ih6->ip_version_traffic_class_and_flow_label & 0xF0) ==
 893               0x60);
 894       ih6 = vlib_buffer_push_ip6 (vm, b, &pkt_ih6->dst_address,
 895                                   &pkt_ih6->src_address, IP_PROTOCOL_TCP);
 896       th->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b, ih6, &bogus);
 897       ASSERT (!bogus);
 898     }
 899
 900   tcp_enqueue_to_ip_lookup_now (wrk, b, bi, is_ip4, fib_index);
 901   TCP_EVT_DBG (TCP_EVT_RST_SENT, tc);
 902 }
 903
 904 /**
 905  * Build and set reset packet for connection
 906  */
 907 void
 908 tcp_send_reset (tcp_connection_t * tc)
 909 {
 910   tcp_worker_ctx_t *wrk = tcp_get_worker (tc->c_thread_index);
 911   vlib_main_t *vm = wrk->vm;
 912   vlib_buffer_t *b;
 913   u32 bi;
 914   tcp_header_t *th;
 915   u16 tcp_hdr_opts_len, advertise_wnd, opts_write_len;
 916   u8 flags;
 917
 918   if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
 919     return;
 920   b = vlib_get_buffer (vm, bi);
 921   tcp_init_buffer (vm, b);
 922
 923   tc->snd_opts_len = tcp_make_options (tc, &tc->snd_opts, tc->state);
 924   tcp_hdr_opts_len = tc->snd_opts_len + sizeof (tcp_header_t);
 925   advertise_wnd = tcp_window_to_advertise (tc, TCP_STATE_ESTABLISHED);
 926   flags = TCP_FLAG_RST;
 927   th = vlib_buffer_push_tcp (b, tc->c_lcl_port, tc->c_rmt_port, tc->snd_nxt,
 928                              tc->rcv_nxt, tcp_hdr_opts_len, flags,
 929                              advertise_wnd);
 930   opts_write_len = tcp_options_write ((u8 *) (th + 1), &tc->snd_opts);
 931   ASSERT (opts_write_len == tc->snd_opts_len);
 932   vnet_buffer (b)->tcp.connection_index = tc->c_c_index;
 933   if (tc->c_is_ip4)
 934     {
 935       ip4_header_t *ih4;
 936       ih4 = vlib_buffer_push_ip4 (vm, b, &tc->c_lcl_ip.ip4,
 937                                   &tc->c_rmt_ip.ip4, IP_PROTOCOL_TCP, 0);
 938       th->checksum = ip4_tcp_udp_compute_checksum (vm, b, ih4);
 939     }
 940   else
 941     {
 942       int bogus = ~0;
 943       ip6_header_t *ih6;
 944       ih6 = vlib_buffer_push_ip6 (vm, b, &tc->c_lcl_ip.ip6,
 945                                   &tc->c_rmt_ip.ip6, IP_PROTOCOL_TCP);
 946       th->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b, ih6, &bogus);
 947       ASSERT (!bogus);
 948     }
 949   tcp_enqueue_to_ip_lookup_now (wrk, b, bi, tc->c_is_ip4, tc->c_fib_index);
 950   TCP_EVT_DBG (TCP_EVT_RST_SENT, tc);
 951 }
 952
 953 static void
 954 tcp_push_ip_hdr (tcp_worker_ctx_t * wrk, tcp_connection_t * tc,
 955                  vlib_buffer_t * b)
 956 {
 957   tcp_header_t *th = vlib_buffer_get_current (b);
 958   vlib_main_t *vm = wrk->vm;
 959   if (tc->c_is_ip4)
 960     {
 961       ip4_header_t *ih;
 962       ih = vlib_buffer_push_ip4 (vm, b, &tc->c_lcl_ip4,
 963                                  &tc->c_rmt_ip4, IP_PROTOCOL_TCP, 1);
 964       th->checksum = ip4_tcp_udp_compute_checksum (vm, b, ih);
 965     }
 966   else
 967     {
 968       ip6_header_t *ih;
 969       int bogus = ~0;
 970
 971       ih = vlib_buffer_push_ip6 (vm, b, &tc->c_lcl_ip6,
 972                                  &tc->c_rmt_ip6, IP_PROTOCOL_TCP);
 973       th->checksum = ip6_tcp_udp_icmp_compute_checksum (vm, b, ih, &bogus);
 974       ASSERT (!bogus);
 975     }
 976 }
 977
 978 /**
 979  *  Send SYN
 980  *
 981  *  Builds a SYN packet for a half-open connection and sends it to ipx_lookup.
 982  *  The packet is not forwarded through tcpx_output to avoid doing lookups
 983  *  in the half_open pool.
 984  */
 985 void
 986 tcp_send_syn (tcp_connection_t * tc)
 987 {
 988   tcp_worker_ctx_t *wrk = tcp_get_worker (tc->c_thread_index);
 989   vlib_main_t *vm = wrk->vm;
 990   vlib_buffer_t *b;
 991   u32 bi;
 992
 993   /*
 994    * Setup retransmit and establish timers before requesting buffer
 995    * such that we can return if we've ran out.
 996    */
 997   tcp_timer_set (tc, TCP_TIMER_ESTABLISH, TCP_ESTABLISH_TIME);
 998   tcp_timer_update (tc, TCP_TIMER_RETRANSMIT_SYN,
 999                     tc->rto * TCP_TO_TIMER_TICK);
1000
1001   if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
1002     return;
1003
1004   b = vlib_get_buffer (vm, bi);
1005   tcp_init_buffer (vm, b);
1006   tcp_make_syn (tc, b);
1007
1008   /* Measure RTT with this */
1009   tc->rtt_ts = tcp_time_now_us (vlib_num_workers ()? 1 : 0);
1010   tc->rtt_seq = tc->snd_nxt;
1011   tc->rto_boff = 0;
1012
1013   tcp_push_ip_hdr (wrk, tc, b);
1014   tcp_enqueue_to_ip_lookup (wrk, b, bi, tc->c_is_ip4, tc->c_fib_index);
1015   TCP_EVT_DBG (TCP_EVT_SYN_SENT, tc);
1016 }
1017
1018 void
1019 tcp_send_synack (tcp_connection_t * tc)
1020 {
1021   tcp_worker_ctx_t *wrk = tcp_get_worker (tc->c_thread_index);
1022   vlib_main_t *vm = wrk->vm;
1023   vlib_buffer_t *b;
1024   u32 bi;
1025
1026   /* Get buffer */
1027   if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
1028     return;
1029
1030   tc->rtt_ts = tcp_time_now_us (tc->c_thread_index);
1031   b = vlib_get_buffer (vm, bi);
1032   tcp_make_synack (tc, b);
1033   tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1034 }
1035
1036 /**
1037  * Flush tx frame populated by retransmits and timer pops
1038  */
1039 void
1040 tcp_flush_frame_to_output (tcp_worker_ctx_t * wrk, u8 is_ip4)
1041 {
1042   if (wrk->tx_frames[!is_ip4])
1043     {
1044       u32 next_index;
1045       next_index = is_ip4 ? tcp4_output_node.index : tcp6_output_node.index;
1046       vlib_put_frame_to_node (wrk->vm, next_index, wrk->tx_frames[!is_ip4]);
1047       wrk->tx_frames[!is_ip4] = 0;
1048     }
1049 }
1050
1051 /**
1052  * Flush ip lookup tx frames populated by timer pops
1053  */
1054 static void
1055 tcp_flush_frame_to_ip_lookup (tcp_worker_ctx_t * wrk, u8 is_ip4)
1056 {
1057   if (wrk->ip_lookup_tx_frames[!is_ip4])
1058     {
1059       u32 next_index;
1060       next_index = is_ip4 ? ip4_lookup_node.index : ip6_lookup_node.index;
1061       vlib_put_frame_to_node (wrk->vm, next_index,
1062                               wrk->ip_lookup_tx_frames[!is_ip4]);
1063       wrk->ip_lookup_tx_frames[!is_ip4] = 0;
1064     }
1065 }
1066
1067 /**
1068  * Flush v4 and v6 tcp and ip-lookup tx frames for thread index
1069  */
1070 void
1071 tcp_flush_frames_to_output (tcp_worker_ctx_t * wrk)
1072 {
1073   tcp_flush_frame_to_output (wrk, 1);
1074   tcp_flush_frame_to_output (wrk, 0);
1075   tcp_flush_frame_to_ip_lookup (wrk, 1);
1076   tcp_flush_frame_to_ip_lookup (wrk, 0);
1077 }
1078
1079 /**
1080  *  Send FIN
1081  */
1082 void
1083 tcp_send_fin (tcp_connection_t * tc)
1084 {
1085   tcp_worker_ctx_t *wrk = tcp_get_worker (tc->c_thread_index);
1086   vlib_main_t *vm = wrk->vm;
1087   vlib_buffer_t *b;
1088   u32 bi;
1089   u8 fin_snt = 0;
1090
1091   fin_snt = tc->flags & TCP_CONN_FINSNT;
1092   if (fin_snt)
1093     tc->snd_nxt = tc->snd_una;
1094
1095   if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
1096     {
1097       /* Out of buffers so program fin retransmit ASAP */
1098       tcp_timer_update (tc, TCP_TIMER_RETRANSMIT, 1);
1099       goto post_enqueue;
1100     }
1101
1102   tcp_retransmit_timer_force_update (tc);
1103   b = vlib_get_buffer (vm, bi);
1104   tcp_init_buffer (vm, b);
1105   tcp_make_fin (tc, b);
1106   tcp_enqueue_to_output_now (wrk, b, bi, tc->c_is_ip4);
1107   TCP_EVT_DBG (TCP_EVT_FIN_SENT, tc);
1108
1109 post_enqueue:
1110   if (!fin_snt)
1111     {
1112       tc->flags |= TCP_CONN_FINSNT;
1113       tc->flags &= ~TCP_CONN_FINPNDG;
1114       /* Account for the FIN */
1115       tc->snd_una_max += 1;
1116       tc->snd_nxt = tc->snd_una_max;
1117     }
1118   else
1119     {
1120       tc->snd_nxt = tc->snd_una_max;
1121     }
1122 }
1123
1124 always_inline u8
1125 tcp_make_state_flags (tcp_connection_t * tc, tcp_state_t next_state)
1126 {
1127   switch (next_state)
1128     {
1129     case TCP_STATE_ESTABLISHED:
1130     case TCP_STATE_CLOSE_WAIT:
1131     case TCP_STATE_TIME_WAIT:
1132     case TCP_STATE_FIN_WAIT_2:
1133       return TCP_FLAG_ACK;
1134     case TCP_STATE_SYN_RCVD:
1135       return TCP_FLAG_SYN | TCP_FLAG_ACK;
1136     case TCP_STATE_SYN_SENT:
1137       return TCP_FLAG_SYN;
1138     case TCP_STATE_LAST_ACK:
1139     case TCP_STATE_FIN_WAIT_1:
1140     case TCP_STATE_CLOSING:
1141       if (tc->snd_nxt + 1 < tc->snd_una_max)
1142         return TCP_FLAG_ACK;
1143       else
1144         return TCP_FLAG_FIN;
1145     default:
1146       clib_warning ("Shouldn't be here!");
1147     }
1148   return 0;
1149 }
1150
1151 /**
1152  * Push TCP header and update connection variables
1153  */
1154 always_inline void
1155 tcp_push_hdr_i (tcp_connection_t * tc, vlib_buffer_t * b,
1156                 tcp_state_t next_state, u8 compute_opts, u8 maybe_burst)
1157 {
1158   u32 advertise_wnd, data_len;
1159   u8 tcp_hdr_opts_len, flags;
1160   tcp_main_t *tm = &tcp_main;
1161   tcp_header_t *th;
1162
1163   data_len = b->current_length;
1164   if (PREDICT_FALSE (b->flags & VLIB_BUFFER_NEXT_PRESENT))
1165     data_len += b->total_length_not_including_first_buffer;
1166
1167   vnet_buffer (b)->tcp.flags = 0;
1168   vnet_buffer (b)->tcp.connection_index = tc->c_c_index;
1169
1170   if (compute_opts)
1171     tc->snd_opts_len = tcp_make_options (tc, &tc->snd_opts, tc->state);
1172
1173   tcp_hdr_opts_len = tc->snd_opts_len + sizeof (tcp_header_t);
1174
1175   if (maybe_burst)
1176     advertise_wnd = tc->rcv_wnd >> tc->rcv_wscale;
1177   else
1178     advertise_wnd = tcp_window_to_advertise (tc, next_state);
1179
1180   flags = tcp_make_state_flags (tc, next_state);
1181   if (PREDICT_FALSE (tc->flags & TCP_CONN_PSH_PENDING))
1182     {
1183       if (seq_geq (tc->psh_seq, tc->snd_nxt)
1184           && seq_lt (tc->psh_seq, tc->snd_nxt + data_len))
1185         flags |= TCP_FLAG_PSH;
1186     }
1187   th = vlib_buffer_push_tcp (b, tc->c_lcl_port, tc->c_rmt_port, tc->snd_nxt,
1188                              tc->rcv_nxt, tcp_hdr_opts_len, flags,
1189                              advertise_wnd);
1190
1191   if (maybe_burst)
1192     {
1193       clib_memcpy_fast ((u8 *) (th + 1),
1194                         tm->wrk_ctx[tc->c_thread_index].cached_opts,
1195                         tc->snd_opts_len);
1196     }
1197   else
1198     {
1199       u8 len = tcp_options_write ((u8 *) (th + 1), &tc->snd_opts);
1200       ASSERT (len == tc->snd_opts_len);
1201     }
1202
1203   /*
1204    * Update connection variables
1205    */
1206
1207   tc->snd_nxt += data_len;
1208   tc->rcv_las = tc->rcv_nxt;
1209
1210   TCP_EVT_DBG (TCP_EVT_PKTIZE, tc);
1211 }
1212
1213 u32
1214 tcp_push_header (tcp_connection_t * tc, vlib_buffer_t * b)
1215 {
1216   tcp_push_hdr_i (tc, b, TCP_STATE_ESTABLISHED, /* compute opts */ 0,
1217                   /* burst */ 1);
1218   tc->snd_una_max = tc->snd_nxt;
1219   ASSERT (seq_leq (tc->snd_una_max, tc->snd_una + tc->snd_wnd));
1220   tcp_validate_txf_size (tc, tc->snd_una_max - tc->snd_una);
1221   /* If not tracking an ACK, start tracking */
1222   if (tc->rtt_ts == 0 && !tcp_in_cong_recovery (tc))
1223     {
1224       tc->rtt_ts = tcp_time_now_us (tc->c_thread_index);
1225       tc->rtt_seq = tc->snd_nxt;
1226     }
1227   if (PREDICT_FALSE (!tcp_timer_is_active (tc, TCP_TIMER_RETRANSMIT)))
1228     {
1229       tcp_retransmit_timer_set (tc);
1230       tc->rto_boff = 0;
1231     }
1232   tcp_trajectory_add_start (b, 3);
1233   return 0;
1234 }
1235
1236 void
1237 tcp_send_ack (tcp_connection_t * tc)
1238 {
1239   tcp_worker_ctx_t *wrk = tcp_get_worker (tc->c_thread_index);
1240   vlib_main_t *vm = wrk->vm;
1241   vlib_buffer_t *b;
1242   u32 bi;
1243
1244   /* Get buffer */
1245   if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
1246     return;
1247   b = vlib_get_buffer (vm, bi);
1248   tcp_init_buffer (vm, b);
1249
1250   /* Fill in the ACK */
1251   tcp_make_ack (tc, b);
1252   tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1253 }
1254
1255 void
1256 tcp_program_ack (tcp_worker_ctx_t * wrk, tcp_connection_t * tc)
1257 {
1258   if (!(tc->flags & TCP_CONN_SNDACK))
1259     {
1260       vec_add1 (wrk->pending_acks, tc->c_c_index);
1261       tc->flags |= TCP_CONN_SNDACK;
1262     }
1263 }
1264
1265 void
1266 tcp_program_dupack (tcp_worker_ctx_t * wrk, tcp_connection_t * tc)
1267 {
1268   if (!(tc->flags & TCP_CONN_SNDACK))
1269     {
1270       vec_add1 (wrk->pending_acks, tc->c_c_index);
1271       tc->flags |= TCP_CONN_SNDACK;
1272     }
1273   if (tc->pending_dupacks < 255)
1274     tc->pending_dupacks += 1;
1275 }
1276
1277 void
1278 tcp_send_acks (tcp_worker_ctx_t * wrk)
1279 {
1280   u32 thread_index, *pending_acks;
1281   tcp_connection_t *tc;
1282   int i, j, n_acks;
1283
1284   if (!vec_len (wrk->pending_acks))
1285     return;
1286
1287   thread_index = wrk->vm->thread_index;
1288   pending_acks = wrk->pending_acks;
1289   for (i = 0; i < vec_len (pending_acks); i++)
1290     {
1291       tc = tcp_connection_get (pending_acks[i], thread_index);
1292       tc->flags &= ~TCP_CONN_SNDACK;
1293       n_acks = clib_max (1, tc->pending_dupacks);
1294       /* If we're supposed to send dupacks but have no ooo data
1295        * send only one ack */
1296       if (tc->pending_dupacks && !vec_len (tc->snd_sacks))
1297         n_acks = 1;
1298       for (j = 0; j < n_acks; j++)
1299         tcp_send_ack (tc);
1300       tc->pending_dupacks = 0;
1301     }
1302   _vec_len (wrk->pending_acks) = 0;
1303 }
1304
1305 /**
1306  * Delayed ack timer handler
1307  *
1308  * Sends delayed ACK when timer expires
1309  */
1310 void
1311 tcp_timer_delack_handler (u32 index)
1312 {
1313   u32 thread_index = vlib_get_thread_index ();
1314   tcp_connection_t *tc;
1315
1316   tc = tcp_connection_get (index, thread_index);
1317   tc->timers[TCP_TIMER_DELACK] = TCP_TIMER_HANDLE_INVALID;
1318   tcp_send_ack (tc);
1319 }
1320
1321 /**
1322  * Allocate a new buffer and build a new tcp segment
1323  *
1324  * @param wrk           tcp worker
1325  * @param tc            connection for which the segment will be allocated
1326  * @param offset        offset of the first byte in the tx fifo
1327  * @param max_deq_byte  segment size
1328  * @param[out] b        pointer to buffer allocated
1329  *
1330  * @return      the number of bytes in the segment or 0 if buffer cannot be
1331  *              allocated or no data available
1332  */
1333 static int
1334 tcp_prepare_segment (tcp_worker_ctx_t * wrk, tcp_connection_t * tc,
1335                      u32 offset, u32 max_deq_bytes, vlib_buffer_t ** b)
1336 {
1337   u32 bytes_per_buffer = vnet_get_tcp_main ()->bytes_per_buffer;
1338   u32 bi, seg_size;
1339   vlib_main_t *vm = wrk->vm;
1340   int n_bytes = 0;
1341   u8 *data;
1342
1343   seg_size = max_deq_bytes + MAX_HDRS_LEN;
1344
1345   /*
1346    * Prepare options
1347    */
1348   tc->snd_opts_len = tcp_make_options (tc, &tc->snd_opts, tc->state);
1349
1350   /*
1351    * Allocate and fill in buffer(s)
1352    */
1353
1354   /* Easy case, buffer size greater than mss */
1355   if (PREDICT_TRUE (seg_size <= bytes_per_buffer))
1356     {
1357       if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
1358         return 0;
1359       *b = vlib_get_buffer (vm, bi);
1360       data = tcp_init_buffer (vm, *b);
1361       n_bytes = stream_session_peek_bytes (&tc->connection, data, offset,
1362                                            max_deq_bytes);
1363       ASSERT (n_bytes == max_deq_bytes);
1364       b[0]->current_length = n_bytes;
1365       tcp_push_hdr_i (tc, *b, tc->state, /* compute opts */ 0, /* burst */ 0);
1366       if (seq_gt (tc->snd_nxt, tc->snd_una_max))
1367         tc->snd_una_max = tc->snd_nxt;
1368     }
1369   /* Split mss into multiple buffers */
1370   else
1371     {
1372       u32 chain_bi = ~0, n_bufs_per_seg;
1373       u16 n_peeked, len_to_deq, available_bufs;
1374       vlib_buffer_t *chain_b, *prev_b;
1375       int i;
1376
1377       /* Make sure we have enough buffers */
1378       n_bufs_per_seg = ceil ((double) seg_size / bytes_per_buffer);
1379       available_bufs = vec_len (wrk->tx_buffers);
1380       if (n_bufs_per_seg > available_bufs)
1381         {
1382           tcp_alloc_tx_buffers (wrk, &available_bufs, VLIB_FRAME_SIZE);
1383           if (n_bufs_per_seg > available_bufs)
1384             {
1385               *b = 0;
1386               return 0;
1387             }
1388         }
1389
1390       (void) tcp_get_free_buffer_index (wrk, &bi);
1391       ASSERT (bi != (u32) ~ 0);
1392       *b = vlib_get_buffer (vm, bi);
1393       data = tcp_init_buffer (vm, *b);
1394       n_bytes = stream_session_peek_bytes (&tc->connection, data, offset,
1395                                            bytes_per_buffer - MAX_HDRS_LEN);
1396       b[0]->current_length = n_bytes;
1397       b[0]->flags |= VLIB_BUFFER_TOTAL_LENGTH_VALID;
1398       b[0]->total_length_not_including_first_buffer = 0;
1399       max_deq_bytes -= n_bytes;
1400
1401       chain_b = *b;
1402       for (i = 1; i < n_bufs_per_seg; i++)
1403         {
1404           prev_b = chain_b;
1405           len_to_deq = clib_min (max_deq_bytes, bytes_per_buffer);
1406           tcp_get_free_buffer_index (wrk, &chain_bi);
1407           ASSERT (chain_bi != (u32) ~ 0);
1408           chain_b = vlib_get_buffer (vm, chain_bi);
1409           chain_b->current_data = 0;
1410           data = vlib_buffer_get_current (chain_b);
1411           n_peeked = stream_session_peek_bytes (&tc->connection, data,
1412                                                 offset + n_bytes, len_to_deq);
1413           ASSERT (n_peeked == len_to_deq);
1414           n_bytes += n_peeked;
1415           chain_b->current_length = n_peeked;
1416           chain_b->next_buffer = 0;
1417
1418           /* update previous buffer */
1419           prev_b->next_buffer = chain_bi;
1420           prev_b->flags |= VLIB_BUFFER_NEXT_PRESENT;
1421
1422           max_deq_bytes -= n_peeked;
1423           b[0]->total_length_not_including_first_buffer += n_peeked;
1424         }
1425
1426       tcp_push_hdr_i (tc, *b, tc->state, /* compute opts */ 0, /* burst */ 0);
1427       if (seq_gt (tc->snd_nxt, tc->snd_una_max))
1428         tc->snd_una_max = tc->snd_nxt;
1429     }
1430
1431   ASSERT (n_bytes > 0);
1432   ASSERT (((*b)->current_data + (*b)->current_length) <= bytes_per_buffer);
1433
1434   return n_bytes;
1435 }
1436
1437 /**
1438  * Build a retransmit segment
1439  *
1440  * @return the number of bytes in the segment or 0 if there's nothing to
1441  *         retransmit
1442  */
1443 static u32
1444 tcp_prepare_retransmit_segment (tcp_worker_ctx_t * wrk,
1445                                 tcp_connection_t * tc, u32 offset,
1446                                 u32 max_deq_bytes, vlib_buffer_t ** b)
1447 {
1448   u32 start, available_bytes;
1449   int n_bytes = 0;
1450
1451   ASSERT (tc->state >= TCP_STATE_ESTABLISHED);
1452   ASSERT (max_deq_bytes != 0);
1453
1454   /*
1455    * Make sure we can retransmit something
1456    */
1457   available_bytes = session_tx_fifo_max_dequeue (&tc->connection);
1458   ASSERT (available_bytes >= offset);
1459   available_bytes -= offset;
1460   if (!available_bytes)
1461     return 0;
1462
1463   max_deq_bytes = clib_min (tc->snd_mss, max_deq_bytes);
1464   max_deq_bytes = clib_min (available_bytes, max_deq_bytes);
1465
1466   /* Start is beyond snd_congestion */
1467   start = tc->snd_una + offset;
1468   if (seq_geq (start, tc->snd_congestion))
1469     goto done;
1470
1471   /* Don't overshoot snd_congestion */
1472   if (seq_gt (start + max_deq_bytes, tc->snd_congestion))
1473     {
1474       max_deq_bytes = tc->snd_congestion - start;
1475       if (max_deq_bytes == 0)
1476         goto done;
1477     }
1478
1479   n_bytes = tcp_prepare_segment (wrk, tc, offset, max_deq_bytes, b);
1480   if (!n_bytes)
1481     return 0;
1482
1483   if (tcp_in_fastrecovery (tc))
1484     tc->snd_rxt_bytes += n_bytes;
1485
1486 done:
1487   TCP_EVT_DBG (TCP_EVT_CC_RTX, tc, offset, n_bytes);
1488   return n_bytes;
1489 }
1490
1491 /**
1492  * Reset congestion control, switch cwnd to loss window and try again.
1493  */
1494 static void
1495 tcp_rxt_timeout_cc (tcp_connection_t * tc)
1496 {
1497   TCP_EVT_DBG (TCP_EVT_CC_EVT, tc, 6);
1498   tc->prev_ssthresh = tc->ssthresh;
1499   tc->prev_cwnd = tc->cwnd;
1500
1501   /* Cleanly recover cc (also clears up fast retransmit) */
1502   if (tcp_in_fastrecovery (tc))
1503     {
1504       /* TODO be less aggressive about this */
1505       scoreboard_clear (&tc->sack_sb);
1506       tcp_cc_fastrecovery_exit (tc);
1507     }
1508
1509   /* Start again from the beginning */
1510   tc->cc_algo->congestion (tc);
1511   tc->cwnd = tcp_loss_wnd (tc);
1512   tc->snd_congestion = tc->snd_una_max;
1513   tc->rtt_ts = 0;
1514   tc->cwnd_acc_bytes = 0;
1515   tcp_connection_tx_pacer_reset (tc, tc->cwnd, 2 * tc->snd_mss);
1516   tcp_recovery_on (tc);
1517 }
1518
1519 static inline void
1520 tcp_timer_retransmit_handler_i (u32 index, u8 is_syn)
1521 {
1522   u32 thread_index = vlib_get_thread_index ();
1523   tcp_worker_ctx_t *wrk = tcp_get_worker (thread_index);
1524   vlib_main_t *vm = wrk->vm;
1525   tcp_connection_t *tc;
1526   vlib_buffer_t *b = 0;
1527   u32 bi, n_bytes;
1528
1529   if (is_syn)
1530     {
1531       tc = tcp_half_open_connection_get (index);
1532       /* Note: the connection may have transitioned to ESTABLISHED... */
1533       if (PREDICT_FALSE (tc == 0 || tc->state != TCP_STATE_SYN_SENT))
1534         return;
1535       tc->timers[TCP_TIMER_RETRANSMIT_SYN] = TCP_TIMER_HANDLE_INVALID;
1536     }
1537   else
1538     {
1539       tc = tcp_connection_get (index, thread_index);
1540       /* Note: the connection may have been closed and pool_put */
1541       if (PREDICT_FALSE (tc == 0 || tc->state < TCP_STATE_SYN_RCVD))
1542         return;
1543       tc->timers[TCP_TIMER_RETRANSMIT] = TCP_TIMER_HANDLE_INVALID;
1544     }
1545
1546   if (tc->state >= TCP_STATE_ESTABLISHED)
1547     {
1548       TCP_EVT_DBG (TCP_EVT_CC_EVT, tc, 2);
1549
1550       /* Lost FIN, retransmit and return */
1551       if (tcp_is_lost_fin (tc))
1552         {
1553           tcp_send_fin (tc);
1554           tc->rto_boff += 1;
1555           tc->rto = clib_min (tc->rto << 1, TCP_RTO_MAX);
1556           return;
1557         }
1558
1559       /* Shouldn't be here. This condition is tricky because it has to take
1560        * into account boff > 0 due to persist timeout. */
1561       if ((tc->rto_boff == 0 && tc->snd_una == tc->snd_una_max)
1562           || (tc->rto_boff > 0 && seq_geq (tc->snd_una, tc->snd_congestion)
1563               && !tcp_flight_size (tc)))
1564         {
1565           ASSERT (!tcp_in_recovery (tc));
1566           tc->rto_boff = 0;
1567           return;
1568         }
1569
1570       /* We're not in recovery so make sure rto_boff is 0. Can be non 0 due
1571        * to persist timer timeout */
1572       if (!tcp_in_recovery (tc) && tc->rto_boff > 0)
1573         {
1574           tc->rto_boff = 0;
1575           tcp_update_rto (tc);
1576         }
1577
1578       /* Increment RTO backoff (also equal to number of retries) and go back
1579        * to first un-acked byte  */
1580       tc->rto_boff += 1;
1581
1582       /* First retransmit timeout */
1583       if (tc->rto_boff == 1)
1584         tcp_rxt_timeout_cc (tc);
1585       else
1586         scoreboard_clear (&tc->sack_sb);
1587
1588       /* If we've sent beyond snd_congestion, update it */
1589       if (seq_gt (tc->snd_una_max, tc->snd_congestion))
1590         tc->snd_congestion = tc->snd_una_max;
1591
1592       tc->snd_una_max = tc->snd_nxt = tc->snd_una;
1593       tc->rto = clib_min (tc->rto << 1, TCP_RTO_MAX);
1594
1595       /* Send one segment. Note that n_bytes may be zero due to buffer
1596        * shortfall */
1597       n_bytes = tcp_prepare_retransmit_segment (wrk, tc, 0, tc->snd_mss, &b);
1598
1599       if (n_bytes == 0)
1600         {
1601           tcp_retransmit_timer_force_update (tc);
1602           return;
1603         }
1604
1605       bi = vlib_get_buffer_index (vm, b);
1606
1607       /* For first retransmit, record timestamp (Eifel detection RFC3522) */
1608       if (tc->rto_boff == 1)
1609         tc->snd_rxt_ts = tcp_time_now_w_thread (tc->c_thread_index);
1610
1611       tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1612       tcp_retransmit_timer_force_update (tc);
1613     }
1614   /* Retransmit for SYN */
1615   else if (tc->state == TCP_STATE_SYN_SENT)
1616     {
1617       /* Half-open connection actually moved to established but we were
1618        * waiting for syn retransmit to pop to call cleanup from the right
1619        * thread. */
1620       if (tc->flags & TCP_CONN_HALF_OPEN_DONE)
1621         {
1622           if (tcp_half_open_connection_cleanup (tc))
1623             {
1624               clib_warning ("could not remove half-open connection");
1625               ASSERT (0);
1626             }
1627           return;
1628         }
1629
1630       TCP_EVT_DBG (TCP_EVT_CC_EVT, tc, 2);
1631
1632       /* Try without increasing RTO a number of times. If this fails,
1633        * start growing RTO exponentially */
1634       tc->rto_boff += 1;
1635       if (tc->rto_boff > TCP_RTO_SYN_RETRIES)
1636         tc->rto = clib_min (tc->rto << 1, TCP_RTO_MAX);
1637
1638       tcp_timer_update (tc, TCP_TIMER_RETRANSMIT_SYN,
1639                         tc->rto * TCP_TO_TIMER_TICK);
1640
1641       if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
1642         return;
1643
1644       b = vlib_get_buffer (vm, bi);
1645       tcp_init_buffer (vm, b);
1646       tcp_make_syn (tc, b);
1647
1648       tc->rtt_ts = 0;
1649       TCP_EVT_DBG (TCP_EVT_SYN_RXT, tc, 0);
1650
1651       /* This goes straight to ipx_lookup. Retransmit timer set already */
1652       tcp_push_ip_hdr (wrk, tc, b);
1653       tcp_enqueue_to_ip_lookup (wrk, b, bi, tc->c_is_ip4, tc->c_fib_index);
1654     }
1655   /* Retransmit SYN-ACK */
1656   else if (tc->state == TCP_STATE_SYN_RCVD)
1657     {
1658       TCP_EVT_DBG (TCP_EVT_CC_EVT, tc, 2);
1659
1660       tc->rto_boff += 1;
1661       if (tc->rto_boff > TCP_RTO_SYN_RETRIES)
1662         tc->rto = clib_min (tc->rto << 1, TCP_RTO_MAX);
1663       tc->rtt_ts = 0;
1664
1665       if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
1666         {
1667           tcp_retransmit_timer_force_update (tc);
1668           return;
1669         }
1670
1671       b = vlib_get_buffer (vm, bi);
1672       tcp_init_buffer (vm, b);
1673       tcp_make_synack (tc, b);
1674       TCP_EVT_DBG (TCP_EVT_SYN_RXT, tc, 1);
1675
1676       /* Retransmit timer already updated, just enqueue to output */
1677       tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1678     }
1679   else
1680     {
1681       ASSERT (tc->state == TCP_STATE_CLOSED);
1682       return;
1683     }
1684 }
1685
1686 void
1687 tcp_timer_retransmit_handler (u32 index)
1688 {
1689   tcp_timer_retransmit_handler_i (index, 0);
1690 }
1691
1692 void
1693 tcp_timer_retransmit_syn_handler (u32 index)
1694 {
1695   tcp_timer_retransmit_handler_i (index, 1);
1696 }
1697
1698 /**
1699  * Got 0 snd_wnd from peer, try to do something about it.
1700  *
1701  */
1702 void
1703 tcp_timer_persist_handler (u32 index)
1704 {
1705   u32 thread_index = vlib_get_thread_index ();
1706   tcp_worker_ctx_t *wrk = tcp_get_worker (thread_index);
1707   u32 bi, max_snd_bytes, available_bytes, offset;
1708   tcp_main_t *tm = vnet_get_tcp_main ();
1709   vlib_main_t *vm = wrk->vm;
1710   tcp_connection_t *tc;
1711   vlib_buffer_t *b;
1712   int n_bytes = 0;
1713   u8 *data;
1714
1715   tc = tcp_connection_get_if_valid (index, thread_index);
1716
1717   if (!tc)
1718     return;
1719
1720   /* Make sure timer handle is set to invalid */
1721   tc->timers[TCP_TIMER_PERSIST] = TCP_TIMER_HANDLE_INVALID;
1722
1723   /* Problem already solved or worse */
1724   if (tc->state == TCP_STATE_CLOSED || tc->state > TCP_STATE_ESTABLISHED
1725       || tc->snd_wnd > tc->snd_mss)
1726     return;
1727
1728   available_bytes = session_tx_fifo_max_dequeue (&tc->connection);
1729   offset = tc->snd_una_max - tc->snd_una;
1730
1731   /* Reprogram persist if no new bytes available to send. We may have data
1732    * next time */
1733   if (!available_bytes)
1734     {
1735       tcp_persist_timer_set (tc);
1736       return;
1737     }
1738
1739   if (available_bytes <= offset)
1740     {
1741       ASSERT (tcp_timer_is_active (tc, TCP_TIMER_RETRANSMIT));
1742       return;
1743     }
1744
1745   /* Increment RTO backoff */
1746   tc->rto_boff += 1;
1747   tc->rto = clib_min (tc->rto << 1, TCP_RTO_MAX);
1748
1749   /*
1750    * Try to force the first unsent segment (or buffer)
1751    */
1752   if (PREDICT_FALSE (tcp_get_free_buffer_index (wrk, &bi)))
1753     {
1754       tcp_persist_timer_set (tc);
1755       return;
1756     }
1757   b = vlib_get_buffer (vm, bi);
1758   data = tcp_init_buffer (vm, b);
1759
1760   tcp_validate_txf_size (tc, offset);
1761   tc->snd_opts_len = tcp_make_options (tc, &tc->snd_opts, tc->state);
1762   max_snd_bytes = clib_min (tc->snd_mss, tm->bytes_per_buffer - MAX_HDRS_LEN);
1763   n_bytes = stream_session_peek_bytes (&tc->connection, data, offset,
1764                                        max_snd_bytes);
1765   b->current_length = n_bytes;
1766   ASSERT (n_bytes != 0 && (tcp_timer_is_active (tc, TCP_TIMER_RETRANSMIT)
1767                            || tc->snd_nxt == tc->snd_una_max
1768                            || tc->rto_boff > 1));
1769
1770   tcp_push_hdr_i (tc, b, tc->state, /* compute opts */ 0, /* burst */ 0);
1771   tc->snd_una_max = tc->snd_nxt;
1772   tcp_validate_txf_size (tc, tc->snd_una_max - tc->snd_una);
1773   tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1774
1775   /* Just sent new data, enable retransmit */
1776   tcp_retransmit_timer_update (tc);
1777 }
1778
1779 /**
1780  * Retransmit first unacked segment
1781  */
1782 int
1783 tcp_retransmit_first_unacked (tcp_worker_ctx_t * wrk, tcp_connection_t * tc)
1784 {
1785   u32 bi, old_snd_nxt, n_bytes;
1786   vlib_main_t *vm = wrk->vm;
1787   vlib_buffer_t *b;
1788
1789   old_snd_nxt = tc->snd_nxt;
1790   tc->snd_nxt = tc->snd_una;
1791
1792   TCP_EVT_DBG (TCP_EVT_CC_EVT, tc, 1);
1793
1794   n_bytes = tcp_prepare_retransmit_segment (wrk, tc, 0, tc->snd_mss, &b);
1795   if (!n_bytes)
1796     return -1;
1797
1798   bi = vlib_get_buffer_index (vm, b);
1799   tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1800   tc->snd_nxt = old_snd_nxt;
1801
1802   return 0;
1803 }
1804
1805 static int
1806 tcp_fast_retransmit_unsent (tcp_worker_ctx_t * wrk, tcp_connection_t * tc,
1807                             u32 burst_size)
1808 {
1809   u32 offset, n_segs = 0, n_written, bi;
1810   vlib_main_t *vm = wrk->vm;
1811   vlib_buffer_t *b = 0;
1812
1813   tc->snd_nxt = tc->snd_una_max;
1814   offset = tc->snd_una_max - tc->snd_una;
1815   while (n_segs < burst_size)
1816     {
1817       n_written = tcp_prepare_segment (wrk, tc, offset, tc->snd_mss, &b);
1818       if (!n_written)
1819         goto done;
1820
1821       bi = vlib_get_buffer_index (vm, b);
1822       tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1823       offset += n_written;
1824       n_segs += 1;
1825     }
1826
1827 done:
1828   return n_segs;
1829 }
1830
1831 #define scoreboard_rescue_rxt_valid(_sb, _tc)                   \
1832     (seq_geq (_sb->rescue_rxt, _tc->snd_una)                    \
1833         && seq_leq (_sb->rescue_rxt, _tc->snd_congestion))
1834
1835 /**
1836  * Do fast retransmit with SACKs
1837  */
1838 int
1839 tcp_fast_retransmit_sack (tcp_worker_ctx_t * wrk, tcp_connection_t * tc,
1840                           u32 burst_size)
1841 {
1842   u32 n_written = 0, offset, max_bytes, n_segs = 0, n_segs_now;
1843   sack_scoreboard_hole_t *hole;
1844   vlib_main_t *vm = wrk->vm;
1845   vlib_buffer_t *b = 0;
1846   sack_scoreboard_t *sb;
1847   u32 bi, old_snd_nxt;
1848   int snd_space;
1849   u32 max_deq;
1850   u8 snd_limited = 0, can_rescue = 0;
1851
1852   ASSERT (tcp_in_fastrecovery (tc));
1853
1854   snd_space = tcp_available_cc_snd_space (tc);
1855   if (snd_space < tc->snd_mss)
1856     {
1857       tcp_program_fastretransmit (wrk, tc);
1858       return 0;
1859     }
1860
1861   TCP_EVT_DBG (TCP_EVT_CC_EVT, tc, 0);
1862   old_snd_nxt = tc->snd_nxt;
1863   sb = &tc->sack_sb;
1864   hole = scoreboard_get_hole (sb, sb->cur_rxt_hole);
1865
1866   max_deq = session_tx_fifo_max_dequeue (&tc->connection);
1867   max_deq -= tc->snd_una_max - tc->snd_una;
1868
1869   while (snd_space > 0 && n_segs < burst_size)
1870     {
1871       hole = scoreboard_next_rxt_hole (sb, hole, max_deq, &can_rescue,
1872                                        &snd_limited);
1873       if (!hole)
1874         {
1875           if (max_deq)
1876             {
1877               snd_space = clib_min (max_deq, snd_space);
1878               burst_size = clib_min (burst_size - n_segs,
1879                                      snd_space / tc->snd_mss);
1880               n_segs_now = tcp_fast_retransmit_unsent (wrk, tc, burst_size);
1881               if (max_deq > n_segs_now * tc->snd_mss)
1882                 tcp_program_fastretransmit (wrk, tc);
1883               n_segs += n_segs_now;
1884               goto done;
1885             }
1886
1887           if (!can_rescue || scoreboard_rescue_rxt_valid (sb, tc))
1888             break;
1889
1890           /* If rescue rxt undefined or less than snd_una then one segment of
1891            * up to SMSS octets that MUST include the highest outstanding
1892            * unSACKed sequence number SHOULD be returned, and RescueRxt set to
1893            * RecoveryPoint. HighRxt MUST NOT be updated.
1894            */
1895           max_bytes = clib_min (tc->snd_mss,
1896                                 tc->snd_congestion - tc->snd_una);
1897           max_bytes = clib_min (max_bytes, snd_space);
1898           offset = tc->snd_congestion - tc->snd_una - max_bytes;
1899           sb->rescue_rxt = tc->snd_congestion;
1900           tc->snd_nxt = tc->snd_una + offset;
1901           n_written = tcp_prepare_retransmit_segment (wrk, tc, offset,
1902                                                       max_bytes, &b);
1903           if (!n_written)
1904             goto done;
1905
1906           bi = vlib_get_buffer_index (vm, b);
1907           tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1908           n_segs += 1;
1909           break;
1910         }
1911
1912       max_bytes = clib_min (hole->end - sb->high_rxt, snd_space);
1913       max_bytes = snd_limited ? clib_min (max_bytes, tc->snd_mss) : max_bytes;
1914       if (max_bytes == 0)
1915         break;
1916
1917       offset = sb->high_rxt - tc->snd_una;
1918       tc->snd_nxt = sb->high_rxt;
1919       n_written = tcp_prepare_retransmit_segment (wrk, tc, offset, max_bytes,
1920                                                   &b);
1921       ASSERT (n_written <= snd_space);
1922
1923       /* Nothing left to retransmit */
1924       if (n_written == 0)
1925         break;
1926
1927       bi = vlib_get_buffer_index (vm, b);
1928       tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1929
1930       sb->high_rxt += n_written;
1931       snd_space -= n_written;
1932       n_segs += 1;
1933     }
1934
1935   if (hole)
1936     tcp_program_fastretransmit (wrk, tc);
1937
1938 done:
1939   /* If window allows, send 1 SMSS of new data */
1940   tc->snd_nxt = old_snd_nxt;
1941   return n_segs;
1942 }
1943
1944 /**
1945  * Fast retransmit without SACK info
1946  */
1947 int
1948 tcp_fast_retransmit_no_sack (tcp_worker_ctx_t * wrk, tcp_connection_t * tc,
1949                              u32 burst_size)
1950 {
1951   u32 n_written = 0, offset = 0, bi, old_snd_nxt, max_deq, n_segs_now;
1952   vlib_main_t *vm = wrk->vm;
1953   int snd_space, n_segs = 0;
1954   vlib_buffer_t *b;
1955
1956   ASSERT (tcp_in_fastrecovery (tc));
1957   TCP_EVT_DBG (TCP_EVT_CC_EVT, tc, 0);
1958   old_snd_nxt = tc->snd_nxt;
1959
1960   if (!tcp_fastrecovery_first (tc))
1961     goto send_unsent;
1962
1963   /* RFC 6582: [If a partial ack], retransmit the first unacknowledged
1964    * segment. */
1965   snd_space = tc->sack_sb.last_bytes_delivered;
1966   tc->snd_nxt = tc->snd_una;
1967   while (snd_space > 0 && n_segs < burst_size)
1968     {
1969       n_written = tcp_prepare_retransmit_segment (wrk, tc, offset,
1970                                                   tc->snd_mss, &b);
1971
1972       /* Nothing left to retransmit */
1973       if (n_written == 0)
1974         break;
1975
1976       bi = vlib_get_buffer_index (vm, b);
1977       tcp_enqueue_to_output (wrk, b, bi, tc->c_is_ip4);
1978       snd_space -= n_written;
1979       offset += n_written;
1980       n_segs += 1;
1981     }
1982
1983   if (n_segs == burst_size)
1984     goto done;
1985
1986 send_unsent:
1987
1988   /* RFC 6582: Send a new segment if permitted by the new value of cwnd. */
1989   snd_space = tcp_available_cc_snd_space (tc);
1990   if (snd_space < tc->snd_mss || tc->snd_mss == 0)
1991     goto done;
1992
1993   max_deq = session_tx_fifo_max_dequeue (&tc->connection);
1994   max_deq -= tc->snd_una_max - tc->snd_una;
1995   if (max_deq)
1996     {
1997       snd_space = clib_min (max_deq, snd_space);
1998       burst_size = clib_min (burst_size - n_segs, snd_space / tc->snd_mss);
1999       n_segs_now = tcp_fast_retransmit_unsent (wrk, tc, burst_size);
2000       if (max_deq > n_segs_now * tc->snd_mss)
2001         tcp_program_fastretransmit (wrk, tc);
2002       n_segs += n_segs_now;
2003     }
2004
2005   /* Restore snd_nxt */
2006   tc->snd_nxt = old_snd_nxt;
2007
2008 done:
2009   tcp_fastrecovery_first_off (tc);
2010   return n_segs;
2011 }
2012
2013 /**
2014  * Do fast retransmit
2015  */
2016 int
2017 tcp_fast_retransmit (tcp_worker_ctx_t * wrk, tcp_connection_t * tc,
2018                      u32 burst_size)
2019 {
2020   if (tcp_opts_sack_permitted (&tc->rcv_opts))
2021     return tcp_fast_retransmit_sack (wrk, tc, burst_size);
2022   else
2023     return tcp_fast_retransmit_no_sack (wrk, tc, burst_size);
2024 }
2025
2026 static void
2027 tcp_output_handle_link_local (tcp_connection_t * tc0, vlib_buffer_t * b0,
2028                               u16 * next0, u32 * error0)
2029 {
2030   ip_adjacency_t *adj;
2031   adj_index_t ai;
2032
2033   /* Not thread safe but as long as the connection exists the adj should
2034    * not be removed */
2035   ai = adj_nbr_find (FIB_PROTOCOL_IP6, VNET_LINK_IP6, &tc0->c_rmt_ip,
2036                      tc0->sw_if_index);
2037   if (ai == ADJ_INDEX_INVALID)
2038     {
2039       vnet_buffer (b0)->sw_if_index[VLIB_TX] = ~0;
2040       *next0 = TCP_OUTPUT_NEXT_DROP;
2041       *error0 = TCP_ERROR_LINK_LOCAL_RW;
2042       return;
2043     }
2044
2045   adj = adj_get (ai);
2046   if (PREDICT_TRUE (adj->lookup_next_index == IP_LOOKUP_NEXT_REWRITE))
2047     *next0 = TCP_OUTPUT_NEXT_IP_REWRITE;
2048   else if (adj->lookup_next_index == IP_LOOKUP_NEXT_ARP)
2049     *next0 = TCP_OUTPUT_NEXT_IP_ARP;
2050   else
2051     {
2052       *next0 = TCP_OUTPUT_NEXT_DROP;
2053       *error0 = TCP_ERROR_LINK_LOCAL_RW;
2054     }
2055   vnet_buffer (b0)->ip.adj_index[VLIB_TX] = ai;
2056 }
2057
2058 static void
2059 tcp46_output_trace_frame (vlib_main_t * vm, vlib_node_runtime_t * node,
2060                           u32 * to_next, u32 n_bufs)
2061 {
2062   u32 n_trace = vlib_get_trace_count (vm, node);
2063   tcp_connection_t *tc;
2064   tcp_tx_trace_t *t;
2065   vlib_buffer_t *b;
2066   tcp_header_t *th;
2067   int i;
2068
2069   for (i = 0; i < clib_min (n_trace, n_bufs); i++)
2070     {
2071       b = vlib_get_buffer (vm, to_next[i]);
2072       th = vlib_buffer_get_current (b);
2073       tc = tcp_connection_get (vnet_buffer (b)->tcp.connection_index,
2074                                vm->thread_index);
2075       t = vlib_add_trace (vm, node, b, sizeof (*t));
2076       clib_memcpy_fast (&t->tcp_header, th, sizeof (t->tcp_header));
2077       clib_memcpy_fast (&t->tcp_connection, tc, sizeof (t->tcp_connection));
2078     }
2079 }
2080
2081 always_inline void
2082 tcp_output_push_ip (vlib_main_t * vm, vlib_buffer_t * b0,
2083                     tcp_connection_t * tc0, u8 is_ip4)
2084 {
2085   tcp_header_t *th0 = 0;
2086
2087   th0 = vlib_buffer_get_current (b0);
2088   TCP_EVT_DBG (TCP_EVT_OUTPUT, tc0, th0->flags, b0->current_length);
2089   if (is_ip4)
2090     {
2091       vlib_buffer_push_ip4 (vm, b0, &tc0->c_lcl_ip4, &tc0->c_rmt_ip4,
2092                             IP_PROTOCOL_TCP, 1);
2093       b0->flags |= VNET_BUFFER_F_OFFLOAD_TCP_CKSUM;
2094       vnet_buffer (b0)->l4_hdr_offset = (u8 *) th0 - b0->data;
2095       th0->checksum = 0;
2096     }
2097   else
2098     {
2099       ip6_header_t *ih0;
2100       ih0 = vlib_buffer_push_ip6 (vm, b0, &tc0->c_lcl_ip6,
2101                                   &tc0->c_rmt_ip6, IP_PROTOCOL_TCP);
2102       b0->flags |= VNET_BUFFER_F_OFFLOAD_TCP_CKSUM;
2103       vnet_buffer (b0)->l3_hdr_offset = (u8 *) ih0 - b0->data;
2104       vnet_buffer (b0)->l4_hdr_offset = (u8 *) th0 - b0->data;
2105       th0->checksum = 0;
2106     }
2107 }
2108
2109 always_inline void
2110 tcp_output_handle_packet (tcp_connection_t * tc0, vlib_buffer_t * b0,
2111                           u32 * error0, u16 * next0, u8 is_ip4)
2112 {
2113
2114   if (PREDICT_FALSE (tc0->state == TCP_STATE_CLOSED))
2115     {
2116       *error0 = TCP_ERROR_INVALID_CONNECTION;
2117       *next0 = TCP_OUTPUT_NEXT_DROP;
2118       return;
2119     }
2120
2121   vnet_buffer (b0)->sw_if_index[VLIB_TX] = tc0->c_fib_index;
2122   vnet_buffer (b0)->sw_if_index[VLIB_RX] = 0;
2123
2124   if (!is_ip4)
2125     {
2126       if (PREDICT_FALSE (ip6_address_is_link_local_unicast (&tc0->c_rmt_ip6)))
2127         tcp_output_handle_link_local (tc0, b0, next0, error0);
2128     }
2129
2130   if (!TCP_ALWAYS_ACK)
2131     tcp_timer_reset (tc0, TCP_TIMER_DELACK);
2132 }
2133
2134 always_inline uword
2135 tcp46_output_inline (vlib_main_t * vm, vlib_node_runtime_t * node,
2136                      vlib_frame_t * frame, int is_ip4)
2137 {
2138   u32 n_left_from, *from, thread_index = vm->thread_index;
2139   vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b;
2140   u16 nexts[VLIB_FRAME_SIZE], *next;
2141
2142   from = vlib_frame_vector_args (frame);
2143   n_left_from = frame->n_vectors;
2144   tcp_set_time_now (tcp_get_worker (thread_index));
2145
2146   if (PREDICT_FALSE (node->flags & VLIB_NODE_FLAG_TRACE))
2147     tcp46_output_trace_frame (vm, node, from, n_left_from);
2148
2149   vlib_get_buffers (vm, from, bufs, n_left_from);
2150   b = bufs;
2151   next = nexts;
2152
2153   while (n_left_from >= 4)
2154     {
2155       u32 error0 = TCP_ERROR_PKTS_SENT, error1 = TCP_ERROR_PKTS_SENT;
2156       tcp_connection_t *tc0, *tc1;
2157
2158       {
2159         vlib_prefetch_buffer_header (b[2], STORE);
2160         CLIB_PREFETCH (b[2]->data, 2 * CLIB_CACHE_LINE_BYTES, STORE);
2161
2162         vlib_prefetch_buffer_header (b[3], STORE);
2163         CLIB_PREFETCH (b[3]->data, 2 * CLIB_CACHE_LINE_BYTES, STORE);
2164       }
2165
2166       next[0] = next[1] = TCP_OUTPUT_NEXT_IP_LOOKUP;
2167
2168       tc0 = tcp_connection_get (vnet_buffer (b[0])->tcp.connection_index,
2169                                 thread_index);
2170       tc1 = tcp_connection_get (vnet_buffer (b[1])->tcp.connection_index,
2171                                 thread_index);
2172
2173       tcp_output_push_ip (vm, b[0], tc0, is_ip4);
2174       tcp_output_push_ip (vm, b[1], tc1, is_ip4);
2175
2176       tcp_output_handle_packet (tc0, b[0], &error0, &next[0], is_ip4);
2177       tcp_output_handle_packet (tc1, b[1], &error1, &next[1], is_ip4);
2178
2179       b += 2;
2180       next += 2;
2181       n_left_from -= 2;
2182     }
2183   while (n_left_from > 0)
2184     {
2185       u32 error0 = TCP_ERROR_PKTS_SENT;
2186       tcp_connection_t *tc0;
2187
2188       if (n_left_from > 1)
2189         {
2190           vlib_prefetch_buffer_header (b[1], STORE);
2191           CLIB_PREFETCH (b[1]->data, 2 * CLIB_CACHE_LINE_BYTES, STORE);
2192         }
2193
2194       next[0] = TCP_OUTPUT_NEXT_IP_LOOKUP;
2195       tc0 = tcp_connection_get (vnet_buffer (b[0])->tcp.connection_index,
2196                                 thread_index);
2197
2198       tcp_output_push_ip (vm, b[0], tc0, is_ip4);
2199       tcp_output_handle_packet (tc0, b[0], &error0, &next[0], is_ip4);
2200
2201       b += 1;
2202       next += 1;
2203       n_left_from -= 1;
2204     }
2205
2206   vlib_buffer_enqueue_to_next (vm, node, from, nexts, frame->n_vectors);
2207   return frame->n_vectors;
2208 }
2209
2210 static uword
2211 tcp4_output (vlib_main_t * vm, vlib_node_runtime_t * node,
2212              vlib_frame_t * from_frame)
2213 {
2214   return tcp46_output_inline (vm, node, from_frame, 1 /* is_ip4 */ );
2215 }
2216
2217 static uword
2218 tcp6_output (vlib_main_t * vm, vlib_node_runtime_t * node,
2219              vlib_frame_t * from_frame)
2220 {
2221   return tcp46_output_inline (vm, node, from_frame, 0 /* is_ip4 */ );
2222 }
2223
2224 /* *INDENT-OFF* */
2225 VLIB_REGISTER_NODE (tcp4_output_node) =
2226 {
2227   .function = tcp4_output,
2228   .name = "tcp4-output",
2229   /* Takes a vector of packets. */
2230   .vector_size = sizeof (u32),
2231   .n_errors = TCP_N_ERROR,
2232   .protocol_hint = VLIB_NODE_PROTO_HINT_TCP,
2233   .error_strings = tcp_error_strings,
2234   .n_next_nodes = TCP_OUTPUT_N_NEXT,
2235   .next_nodes = {
2236 #define _(s,n) [TCP_OUTPUT_NEXT_##s] = n,
2237     foreach_tcp4_output_next
2238 #undef _
2239   },
2240   .format_buffer = format_tcp_header,
2241   .format_trace = format_tcp_tx_trace,
2242 };
2243 /* *INDENT-ON* */
2244
2245 VLIB_NODE_FUNCTION_MULTIARCH (tcp4_output_node, tcp4_output);
2246
2247 /* *INDENT-OFF* */
2248 VLIB_REGISTER_NODE (tcp6_output_node) =
2249 {
2250   .function = tcp6_output,
2251   .name = "tcp6-output",
2252     /* Takes a vector of packets. */
2253   .vector_size = sizeof (u32),
2254   .n_errors = TCP_N_ERROR,
2255   .protocol_hint = VLIB_NODE_PROTO_HINT_TCP,
2256   .error_strings = tcp_error_strings,
2257   .n_next_nodes = TCP_OUTPUT_N_NEXT,
2258   .next_nodes = {
2259 #define _(s,n) [TCP_OUTPUT_NEXT_##s] = n,
2260     foreach_tcp6_output_next
2261 #undef _
2262   },
2263   .format_buffer = format_tcp_header,
2264   .format_trace = format_tcp_tx_trace,
2265 };
2266 /* *INDENT-ON* */
2267
2268 VLIB_NODE_FUNCTION_MULTIARCH (tcp6_output_node, tcp6_output);
2269
2270 typedef enum _tcp_reset_next
2271 {
2272   TCP_RESET_NEXT_DROP,
2273   TCP_RESET_NEXT_IP_LOOKUP,
2274   TCP_RESET_N_NEXT
2275 } tcp_reset_next_t;
2276
2277 #define foreach_tcp4_reset_next         \
2278   _(DROP, "error-drop")                 \
2279   _(IP_LOOKUP, "ip4-lookup")
2280
2281 #define foreach_tcp6_reset_next         \
2282   _(DROP, "error-drop")                 \
2283   _(IP_LOOKUP, "ip6-lookup")
2284
2285 static uword
2286 tcp46_send_reset_inline (vlib_main_t * vm, vlib_node_runtime_t * node,
2287                          vlib_frame_t * from_frame, u8 is_ip4)
2288 {
2289   u32 n_left_from, next_index, *from, *to_next;
2290   u32 my_thread_index = vm->thread_index;
2291
2292   from = vlib_frame_vector_args (from_frame);
2293   n_left_from = from_frame->n_vectors;
2294
2295   next_index = node->cached_next_index;
2296
2297   while (n_left_from > 0)
2298     {
2299       u32 n_left_to_next;
2300
2301       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
2302
2303       while (n_left_from > 0 && n_left_to_next > 0)
2304         {
2305           u32 bi0;
2306           vlib_buffer_t *b0;
2307           tcp_tx_trace_t *t0;
2308           tcp_header_t *th0;
2309           u32 error0 = TCP_ERROR_RST_SENT, next0 = TCP_RESET_NEXT_IP_LOOKUP;
2310
2311           bi0 = from[0];
2312           to_next[0] = bi0;
2313           from += 1;
2314           to_next += 1;
2315           n_left_from -= 1;
2316           n_left_to_next -= 1;
2317
2318           b0 = vlib_get_buffer (vm, bi0);
2319
2320           if (tcp_make_reset_in_place (vm, b0, vnet_buffer (b0)->tcp.flags,
2321                                        my_thread_index, is_ip4))
2322             {
2323               error0 = TCP_ERROR_LOOKUP_DROPS;
2324               next0 = TCP_RESET_NEXT_DROP;
2325               goto done;
2326             }
2327
2328           /* Prepare to send to IP lookup */
2329           vnet_buffer (b0)->sw_if_index[VLIB_TX] = ~0;
2330           next0 = TCP_RESET_NEXT_IP_LOOKUP;
2331
2332         done:
2333           b0->error = node->errors[error0];
2334           b0->flags |= VNET_BUFFER_F_LOCALLY_ORIGINATED;
2335           if (PREDICT_FALSE (b0->flags & VLIB_BUFFER_IS_TRACED))
2336             {
2337               th0 = vlib_buffer_get_current (b0);
2338               if (is_ip4)
2339                 th0 = ip4_next_header ((ip4_header_t *) th0);
2340               else
2341                 th0 = ip6_next_header ((ip6_header_t *) th0);
2342               t0 = vlib_add_trace (vm, node, b0, sizeof (*t0));
2343               clib_memcpy_fast (&t0->tcp_header, th0,
2344                                 sizeof (t0->tcp_header));
2345             }
2346
2347           vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
2348                                            n_left_to_next, bi0, next0);
2349         }
2350       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
2351     }
2352   return from_frame->n_vectors;
2353 }
2354
2355 static uword
2356 tcp4_send_reset (vlib_main_t * vm, vlib_node_runtime_t * node,
2357                  vlib_frame_t * from_frame)
2358 {
2359   return tcp46_send_reset_inline (vm, node, from_frame, 1);
2360 }
2361
2362 static uword
2363 tcp6_send_reset (vlib_main_t * vm, vlib_node_runtime_t * node,
2364                  vlib_frame_t * from_frame)
2365 {
2366   return tcp46_send_reset_inline (vm, node, from_frame, 0);
2367 }
2368
2369 /* *INDENT-OFF* */
2370 VLIB_REGISTER_NODE (tcp4_reset_node) = {
2371   .function = tcp4_send_reset,
2372   .name = "tcp4-reset",
2373   .vector_size = sizeof (u32),
2374   .n_errors = TCP_N_ERROR,
2375   .error_strings = tcp_error_strings,
2376   .n_next_nodes = TCP_RESET_N_NEXT,
2377   .next_nodes = {
2378 #define _(s,n) [TCP_RESET_NEXT_##s] = n,
2379     foreach_tcp4_reset_next
2380 #undef _
2381   },
2382   .format_trace = format_tcp_tx_trace,
2383 };
2384 /* *INDENT-ON* */
2385
2386 VLIB_NODE_FUNCTION_MULTIARCH (tcp4_reset_node, tcp4_send_reset);
2387
2388 /* *INDENT-OFF* */
2389 VLIB_REGISTER_NODE (tcp6_reset_node) = {
2390   .function = tcp6_send_reset,
2391   .name = "tcp6-reset",
2392   .vector_size = sizeof (u32),
2393   .n_errors = TCP_N_ERROR,
2394   .error_strings = tcp_error_strings,
2395   .n_next_nodes = TCP_RESET_N_NEXT,
2396   .next_nodes = {
2397 #define _(s,n) [TCP_RESET_NEXT_##s] = n,
2398     foreach_tcp6_reset_next
2399 #undef _
2400   },
2401   .format_trace = format_tcp_tx_trace,
2402 };
2403 /* *INDENT-ON* */
2404
2405 VLIB_NODE_FUNCTION_MULTIARCH (tcp6_reset_node, tcp6_send_reset);
2406
2407 /*
2408  * fd.io coding-style-patch-verification: ON
2409  *
2410  * Local Variables:
2411  * eval: (c-set-style "gnu")
2412  * End:
2413  */