xref: /linux/net/ipv4/tcp_output.c (revision 1c3e7e0439773357e25d13d9cd56e5138593e5bd)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * INET		An implementation of the TCP/IP protocol suite for the LINUX
4  *		operating system.  INET is implemented using the  BSD Socket
5  *		interface as the means of communication with the user level.
6  *
7  *		Implementation of the Transmission Control Protocol(TCP).
8  *
9  * Authors:	Ross Biro
10  *		Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
11  *		Mark Evans, <evansmp@uhura.aston.ac.uk>
12  *		Corey Minyard <wf-rch!minyard@relay.EU.net>
13  *		Florian La Roche, <flla@stud.uni-sb.de>
14  *		Charles Hedrick, <hedrick@klinzhai.rutgers.edu>
15  *		Linus Torvalds, <torvalds@cs.helsinki.fi>
16  *		Alan Cox, <gw4pts@gw4pts.ampr.org>
17  *		Matthew Dillon, <dillon@apollo.west.oic.com>
18  *		Arnt Gulbrandsen, <agulbra@nvg.unit.no>
19  *		Jorge Cwik, <jorge@laser.satlink.net>
20  */
21 
22 /*
23  * Changes:	Pedro Roque	:	Retransmit queue handled by TCP.
24  *				:	Fragmentation on mtu decrease
25  *				:	Segment collapse on retransmit
26  *				:	AF independence
27  *
28  *		Linus Torvalds	:	send_delayed_ack
29  *		David S. Miller	:	Charge memory using the right skb
30  *					during syn/ack processing.
31  *		David S. Miller :	Output engine completely rewritten.
32  *		Andrea Arcangeli:	SYNACK carry ts_recent in tsecr.
33  *		Cacophonix Gaul :	draft-minshall-nagle-01
34  *		J Hadi Salim	:	ECN support
35  *
36  */
37 
38 #define pr_fmt(fmt) "TCP: " fmt
39 
40 #include <net/tcp.h>
41 #include <net/tcp_ecn.h>
42 #include <net/mptcp.h>
43 #include <net/smc.h>
44 #include <net/proto_memory.h>
45 #include <net/psp.h>
46 
47 #include <linux/compiler.h>
48 #include <linux/gfp.h>
49 #include <linux/module.h>
50 #include <linux/static_key.h>
51 #include <linux/skbuff_ref.h>
52 
53 #include <trace/events/tcp.h>
54 
55 void noinline tcp_mstamp_refresh(struct tcp_sock *tp)
56 {
57 	tcp_mstamp_refresh_inline(tp);
58 }
59 
60 static bool tcp_write_xmit(struct sock *sk, unsigned int mss_now, int nonagle,
61 			   int push_one, gfp_t gfp);
62 
63 /* Insert skb into rb tree, ordered by TCP_SKB_CB(skb)->seq */
64 void tcp_rbtree_insert(struct rb_root *root, struct sk_buff *skb)
65 {
66 	struct rb_node **p = &root->rb_node;
67 	struct rb_node *parent = NULL;
68 	struct sk_buff *skb1;
69 
70 	while (*p) {
71 		parent = *p;
72 		skb1 = rb_to_skb(parent);
73 		if (before(TCP_SKB_CB(skb)->seq, TCP_SKB_CB(skb1)->seq))
74 			p = &parent->rb_left;
75 		else
76 			p = &parent->rb_right;
77 	}
78 	rb_link_node(&skb->rbnode, parent, p);
79 	rb_insert_color(&skb->rbnode, root);
80 }
81 
82 /* Account for new data that has been sent to the network. */
83 static void tcp_event_new_data_sent(struct sock *sk, struct sk_buff *skb)
84 {
85 	struct inet_connection_sock *icsk = inet_csk(sk);
86 	struct tcp_sock *tp = tcp_sk(sk);
87 	unsigned int prior_packets = tp->packets_out;
88 
89 	WRITE_ONCE(tp->snd_nxt, TCP_SKB_CB(skb)->end_seq);
90 
91 	__skb_unlink(skb, &sk->sk_write_queue);
92 	tcp_rbtree_insert(&sk->tcp_rtx_queue, skb);
93 
94 	if (tp->highest_sack == NULL)
95 		tp->highest_sack = skb;
96 
97 	tp->packets_out += tcp_skb_pcount(skb);
98 	if (!prior_packets || icsk->icsk_pending == ICSK_TIME_LOSS_PROBE)
99 		tcp_rearm_rto(sk);
100 
101 	NET_ADD_STATS(sock_net(sk), LINUX_MIB_TCPORIGDATASENT,
102 		      tcp_skb_pcount(skb));
103 	tcp_check_space(sk);
104 }
105 
106 /* SND.NXT, if window was not shrunk or the amount of shrunk was less than one
107  * window scaling factor due to loss of precision.
108  * If window has been shrunk, what should we make? It is not clear at all.
109  * Using SND.UNA we will fail to open window, SND.NXT is out of window. :-(
110  * Anything in between SND.UNA...SND.UNA+SND.WND also can be already
111  * invalid. OK, let's make this for now:
112  */
113 static inline __u32 tcp_acceptable_seq(const struct sock *sk)
114 {
115 	const struct tcp_sock *tp = tcp_sk(sk);
116 
117 	if (!before(tcp_wnd_end(tp), tp->snd_nxt) ||
118 	    (tp->rx_opt.wscale_ok &&
119 	     ((tp->snd_nxt - tcp_wnd_end(tp)) < (1 << tp->rx_opt.rcv_wscale))))
120 		return tp->snd_nxt;
121 	else
122 		return tcp_wnd_end(tp);
123 }
124 
125 /* Calculate mss to advertise in SYN segment.
126  * RFC1122, RFC1063, draft-ietf-tcpimpl-pmtud-01 state that:
127  *
128  * 1. It is independent of path mtu.
129  * 2. Ideally, it is maximal possible segment size i.e. 65535-40.
130  * 3. For IPv4 it is reasonable to calculate it from maximal MTU of
131  *    attached devices, because some buggy hosts are confused by
132  *    large MSS.
133  * 4. We do not make 3, we advertise MSS, calculated from first
134  *    hop device mtu, but allow to raise it to ip_rt_min_advmss.
135  *    This may be overridden via information stored in routing table.
136  * 5. Value 65535 for MSS is valid in IPv6 and means "as large as possible,
137  *    probably even Jumbo".
138  */
139 static __u16 tcp_advertise_mss(struct sock *sk)
140 {
141 	struct tcp_sock *tp = tcp_sk(sk);
142 	const struct dst_entry *dst = __sk_dst_get(sk);
143 	int mss = tp->advmss;
144 
145 	if (dst) {
146 		unsigned int metric = dst_metric_advmss(dst);
147 
148 		if (metric < mss) {
149 			mss = metric;
150 			tp->advmss = mss;
151 		}
152 	}
153 
154 	return (__u16)mss;
155 }
156 
157 /* RFC2861. Reset CWND after idle period longer RTO to "restart window".
158  * This is the first part of cwnd validation mechanism.
159  */
160 void tcp_cwnd_restart(struct sock *sk, s32 delta)
161 {
162 	struct tcp_sock *tp = tcp_sk(sk);
163 	u32 restart_cwnd = tcp_init_cwnd(tp, __sk_dst_get(sk));
164 	u32 cwnd = tcp_snd_cwnd(tp);
165 
166 	tcp_ca_event(sk, CA_EVENT_CWND_RESTART);
167 
168 	WRITE_ONCE(tp->snd_ssthresh, tcp_current_ssthresh(sk));
169 	restart_cwnd = min(restart_cwnd, cwnd);
170 
171 	while ((delta -= inet_csk(sk)->icsk_rto) > 0 && cwnd > restart_cwnd)
172 		cwnd >>= 1;
173 	tcp_snd_cwnd_set(tp, max(cwnd, restart_cwnd));
174 	tp->snd_cwnd_stamp = tcp_jiffies32;
175 	tp->snd_cwnd_used = 0;
176 }
177 
178 /* Congestion state accounting after a packet has been sent. */
179 static void tcp_event_data_sent(struct tcp_sock *tp,
180 				struct sock *sk)
181 {
182 	struct inet_connection_sock *icsk = inet_csk(sk);
183 	const u32 now = tcp_jiffies32;
184 
185 	if (tcp_packets_in_flight(tp) == 0)
186 		tcp_ca_event(sk, CA_EVENT_TX_START);
187 
188 	tp->lsndtime = now;
189 
190 	/* If it is a reply for ato after last received
191 	 * packet, increase pingpong count.
192 	 */
193 	if ((u32)(now - icsk->icsk_ack.lrcvtime) < icsk->icsk_ack.ato)
194 		inet_csk_inc_pingpong_cnt(sk);
195 }
196 
197 /* Account for an ACK we sent. */
198 static inline void tcp_event_ack_sent(struct sock *sk, u32 rcv_nxt)
199 {
200 	struct tcp_sock *tp = tcp_sk(sk);
201 
202 	if (unlikely(tp->compressed_ack)) {
203 		NET_ADD_STATS(sock_net(sk), LINUX_MIB_TCPACKCOMPRESSED,
204 			      tp->compressed_ack);
205 		tp->compressed_ack = 0;
206 		if (hrtimer_try_to_cancel(&tp->compressed_ack_timer) == 1)
207 			__sock_put(sk);
208 	}
209 
210 	if (unlikely(rcv_nxt != tp->rcv_nxt))
211 		return;  /* Special ACK sent by DCTCP to reflect ECN */
212 	tcp_dec_quickack_mode(sk);
213 	inet_csk_clear_xmit_timer(sk, ICSK_TIME_DACK);
214 }
215 
216 /* Determine a window scaling and initial window to offer.
217  * Based on the assumption that the given amount of space
218  * will be offered. Store the results in the tp structure.
219  * NOTE: for smooth operation initial space offering should
220  * be a multiple of mss if possible. We assume here that mss >= 1.
221  * This MUST be enforced by all callers.
222  */
223 void tcp_select_initial_window(const struct sock *sk, int __space, __u32 mss,
224 			       __u32 *rcv_wnd, __u32 *__window_clamp,
225 			       int wscale_ok, __u8 *rcv_wscale,
226 			       __u32 init_rcv_wnd)
227 {
228 	unsigned int space = (__space < 0 ? 0 : __space);
229 	u32 window_clamp = READ_ONCE(*__window_clamp);
230 
231 	/* If no clamp set the clamp to the max possible scaled window */
232 	if (window_clamp == 0)
233 		window_clamp = (U16_MAX << TCP_MAX_WSCALE);
234 	space = min(window_clamp, space);
235 
236 	/* Quantize space offering to a multiple of mss if possible. */
237 	if (space > mss)
238 		space = rounddown(space, mss);
239 
240 	/* NOTE: offering an initial window larger than 32767
241 	 * will break some buggy TCP stacks. If the admin tells us
242 	 * it is likely we could be speaking with such a buggy stack
243 	 * we will truncate our initial window offering to 32K-1
244 	 * unless the remote has sent us a window scaling option,
245 	 * which we interpret as a sign the remote TCP is not
246 	 * misinterpreting the window field as a signed quantity.
247 	 */
248 	if (READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_workaround_signed_windows))
249 		(*rcv_wnd) = min(space, MAX_TCP_WINDOW);
250 	else
251 		(*rcv_wnd) = space;
252 
253 	if (init_rcv_wnd)
254 		*rcv_wnd = min(*rcv_wnd, init_rcv_wnd * mss);
255 
256 	*rcv_wscale = 0;
257 	if (wscale_ok) {
258 		/* Set window scaling on max possible window */
259 		space = max_t(u32, space, READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_rmem[2]));
260 		space = max_t(u32, space, READ_ONCE(sysctl_rmem_max));
261 		space = min_t(u32, space, window_clamp);
262 		*rcv_wscale = clamp_t(int, ilog2(space) - 15,
263 				      0, TCP_MAX_WSCALE);
264 	}
265 	/* Set the clamp no higher than max representable value */
266 	WRITE_ONCE(*__window_clamp,
267 		   min_t(__u32, U16_MAX << (*rcv_wscale), window_clamp));
268 }
269 
270 /* Chose a new window to advertise, update state in tcp_sock for the
271  * socket, and return result with RFC1323 scaling applied.  The return
272  * value can be stuffed directly into th->window for an outgoing
273  * frame.
274  */
275 static u16 tcp_select_window(struct sock *sk)
276 {
277 	struct tcp_sock *tp = tcp_sk(sk);
278 	struct net *net = sock_net(sk);
279 	u32 old_win = tp->rcv_wnd;
280 	u32 cur_win, new_win;
281 
282 	/* Make the window 0 if we failed to queue the data because we
283 	 * are out of memory.
284 	 */
285 	if (unlikely(inet_csk(sk)->icsk_ack.pending & ICSK_ACK_NOMEM)) {
286 		tp->pred_flags = 0;
287 		tp->rcv_wnd = 0;
288 		tp->rcv_wup = tp->rcv_nxt;
289 		tcp_update_max_rcv_wnd_seq(tp);
290 		return 0;
291 	}
292 
293 	cur_win = tcp_receive_window(tp);
294 	new_win = __tcp_select_window(sk);
295 	if (new_win < cur_win) {
296 		/* Danger Will Robinson!
297 		 * Don't update rcv_wup/rcv_wnd here or else
298 		 * we will not be able to advertise a zero
299 		 * window in time.  --DaveM
300 		 *
301 		 * Relax Will Robinson.
302 		 */
303 		if (!READ_ONCE(net->ipv4.sysctl_tcp_shrink_window) || !tp->rx_opt.rcv_wscale) {
304 			/* Never shrink the offered window */
305 			if (new_win == 0)
306 				NET_INC_STATS(net, LINUX_MIB_TCPWANTZEROWINDOWADV);
307 			new_win = ALIGN(cur_win, 1 << tp->rx_opt.rcv_wscale);
308 		}
309 	}
310 
311 	tp->rcv_wnd = new_win;
312 	tp->rcv_wup = tp->rcv_nxt;
313 	tcp_update_max_rcv_wnd_seq(tp);
314 
315 	/* Make sure we do not exceed the maximum possible
316 	 * scaled window.
317 	 */
318 	if (!tp->rx_opt.rcv_wscale &&
319 	    READ_ONCE(net->ipv4.sysctl_tcp_workaround_signed_windows))
320 		new_win = min(new_win, MAX_TCP_WINDOW);
321 	else
322 		new_win = min(new_win, (65535U << tp->rx_opt.rcv_wscale));
323 
324 	/* RFC1323 scaling applied */
325 	new_win >>= tp->rx_opt.rcv_wscale;
326 
327 	/* If we advertise zero window, disable fast path. */
328 	if (new_win == 0) {
329 		tp->pred_flags = 0;
330 		if (old_win)
331 			NET_INC_STATS(net, LINUX_MIB_TCPTOZEROWINDOWADV);
332 	} else if (old_win == 0) {
333 		NET_INC_STATS(net, LINUX_MIB_TCPFROMZEROWINDOWADV);
334 	}
335 
336 	return new_win;
337 }
338 
339 /* Set up ECN state for a packet on a ESTABLISHED socket that is about to
340  * be sent.
341  */
342 static void tcp_ecn_send(struct sock *sk, struct sk_buff *skb,
343 			 struct tcphdr *th, int tcp_header_len)
344 {
345 	struct tcp_sock *tp = tcp_sk(sk);
346 
347 	if (!tcp_ecn_mode_any(tp))
348 		return;
349 
350 	if (tcp_ecn_mode_accecn(tp)) {
351 		if (!tcp_accecn_ace_fail_recv(tp) &&
352 		    !tcp_accecn_ace_fail_send(tp))
353 			INET_ECN_xmit(sk);
354 		else
355 			INET_ECN_dontxmit(sk);
356 		tcp_accecn_set_ace(tp, skb, th);
357 		skb_shinfo(skb)->gso_type |= SKB_GSO_TCP_ACCECN;
358 	} else {
359 		/* Not-retransmitted data segment: set ECT and inject CWR. */
360 		if (skb->len != tcp_header_len &&
361 		    !before(TCP_SKB_CB(skb)->seq, tp->snd_nxt)) {
362 			INET_ECN_xmit(sk);
363 			if (tp->ecn_flags & TCP_ECN_QUEUE_CWR) {
364 				tp->ecn_flags &= ~TCP_ECN_QUEUE_CWR;
365 				th->cwr = 1;
366 				skb_shinfo(skb)->gso_type |= SKB_GSO_TCP_ECN;
367 			}
368 		} else if (!tcp_ca_needs_ecn(sk)) {
369 			/* ACK or retransmitted segment: clear ECT|CE */
370 			INET_ECN_dontxmit(sk);
371 		}
372 		if (tp->ecn_flags & TCP_ECN_DEMAND_CWR)
373 			th->ece = 1;
374 	}
375 }
376 
377 /* Constructs common control bits of non-data skb. If SYN/FIN is present,
378  * auto increment end seqno.
379  */
380 static void tcp_init_nondata_skb(struct sk_buff *skb, struct sock *sk,
381 				 u32 seq, u16 flags)
382 {
383 	skb->ip_summed = CHECKSUM_PARTIAL;
384 
385 	TCP_SKB_CB(skb)->tcp_flags = flags;
386 
387 	tcp_skb_pcount_set(skb, 1);
388 	psp_enqueue_set_decrypted(sk, skb);
389 
390 	TCP_SKB_CB(skb)->seq = seq;
391 	if (flags & (TCPHDR_SYN | TCPHDR_FIN))
392 		seq++;
393 	TCP_SKB_CB(skb)->end_seq = seq;
394 }
395 
396 static inline bool tcp_urg_mode(const struct tcp_sock *tp)
397 {
398 	return tp->snd_una != tp->snd_up;
399 }
400 
401 #define OPTION_SACK_ADVERTISE	BIT(0)
402 #define OPTION_TS		BIT(1)
403 #define OPTION_MD5		BIT(2)
404 #define OPTION_WSCALE		BIT(3)
405 #define OPTION_FAST_OPEN_COOKIE	BIT(8)
406 #define OPTION_SMC		BIT(9)
407 #define OPTION_MPTCP		BIT(10)
408 #define OPTION_AO		BIT(11)
409 #define OPTION_ACCECN		BIT(12)
410 
411 static void smc_options_write(__be32 *ptr, u16 *options)
412 {
413 #if IS_ENABLED(CONFIG_SMC)
414 	if (static_branch_unlikely(&tcp_have_smc)) {
415 		if (unlikely(OPTION_SMC & *options)) {
416 			*ptr++ = htonl((TCPOPT_NOP  << 24) |
417 				       (TCPOPT_NOP  << 16) |
418 				       (TCPOPT_EXP <<  8) |
419 				       (TCPOLEN_EXP_SMC_BASE));
420 			*ptr++ = htonl(TCPOPT_SMC_MAGIC);
421 		}
422 	}
423 #endif
424 }
425 
426 struct tcp_out_options {
427 	/* Following group is cleared in __tcp_transmit_skb() */
428 	struct_group(cleared,
429 		u16 mss;		/* 0 to disable */
430 		u8 bpf_opt_len;		/* length of BPF hdr option */
431 		u8 num_sack_blocks;	/* number of SACK blocks to include */
432 	);
433 
434 	/* Caution: following fields are not cleared in __tcp_transmit_skb() */
435 	u16 options;		/* bit field of OPTION_* */
436 	u8 ws;			/* window scale, 0 to disable */
437 	u8 num_accecn_fields:7,	/* number of AccECN fields needed */
438 	   use_synack_ecn_bytes:1; /* Use synack_ecn_bytes or not */
439 	__u8 *hash_location;	/* temporary pointer, overloaded */
440 	__u32 tsval, tsecr;	/* need to include OPTION_TS */
441 	struct tcp_fastopen_cookie *fastopen_cookie;	/* Fast open cookie */
442 	struct mptcp_out_options mptcp;
443 };
444 
445 static void mptcp_options_write(struct tcphdr *th, __be32 *ptr,
446 				struct tcp_sock *tp,
447 				struct tcp_out_options *opts)
448 {
449 #if IS_ENABLED(CONFIG_MPTCP)
450 	if (unlikely(OPTION_MPTCP & opts->options))
451 		mptcp_write_options(th, ptr, tp, &opts->mptcp);
452 #endif
453 }
454 
455 #ifdef CONFIG_CGROUP_BPF
456 static int bpf_skops_write_hdr_opt_arg0(struct sk_buff *skb,
457 					enum tcp_synack_type synack_type)
458 {
459 	if (unlikely(!skb))
460 		return BPF_WRITE_HDR_TCP_CURRENT_MSS;
461 
462 	if (unlikely(synack_type == TCP_SYNACK_COOKIE))
463 		return BPF_WRITE_HDR_TCP_SYNACK_COOKIE;
464 
465 	return 0;
466 }
467 
468 /* req, syn_skb and synack_type are used when writing synack */
469 static u32 bpf_skops_hdr_opt_len(struct sock *sk, struct sk_buff *skb,
470 				 struct request_sock *req,
471 				 struct sk_buff *syn_skb,
472 				 enum tcp_synack_type synack_type,
473 				 struct tcp_out_options *opts,
474 				 u32 remaining)
475 {
476 	struct bpf_sock_ops_kern sock_ops;
477 	int err;
478 
479 	if (likely(!BPF_SOCK_OPS_TEST_FLAG(tcp_sk(sk),
480 					   BPF_SOCK_OPS_WRITE_HDR_OPT_CB_FLAG)) ||
481 	    !remaining)
482 		return remaining;
483 
484 	/* remaining has already been aligned to 4 bytes, so remaining >= 4 */
485 
486 	/* init sock_ops */
487 	memset(&sock_ops, 0, offsetof(struct bpf_sock_ops_kern, temp));
488 
489 	sock_ops.op = BPF_SOCK_OPS_HDR_OPT_LEN_CB;
490 
491 	if (req) {
492 		/* The listen "sk" cannot be passed here because
493 		 * it is not locked.  It would not make too much
494 		 * sense to do bpf_setsockopt(listen_sk) based
495 		 * on individual connection request also.
496 		 *
497 		 * Thus, "req" is passed here and the cgroup-bpf-progs
498 		 * of the listen "sk" will be run.
499 		 *
500 		 * "req" is also used here for fastopen even the "sk" here is
501 		 * a fullsock "child" sk.  It is to keep the behavior
502 		 * consistent between fastopen and non-fastopen on
503 		 * the bpf programming side.
504 		 */
505 		sock_ops.sk = (struct sock *)req;
506 		sock_ops.syn_skb = syn_skb;
507 	} else {
508 		sock_owned_by_me(sk);
509 
510 		sock_ops.is_fullsock = 1;
511 		sock_ops.is_locked_tcp_sock = 1;
512 		sock_ops.sk = sk;
513 	}
514 
515 	sock_ops.args[0] = bpf_skops_write_hdr_opt_arg0(skb, synack_type);
516 	sock_ops.remaining_opt_len = remaining;
517 	/* tcp_current_mss() does not pass a skb */
518 	if (skb)
519 		bpf_skops_init_skb(&sock_ops, skb, 0);
520 
521 	err = BPF_CGROUP_RUN_PROG_SOCK_OPS_SK(&sock_ops, sk);
522 
523 	if (err || sock_ops.remaining_opt_len == remaining)
524 		return remaining;
525 
526 	opts->bpf_opt_len = remaining - sock_ops.remaining_opt_len;
527 	/* round up to 4 bytes */
528 	opts->bpf_opt_len = (opts->bpf_opt_len + 3) & ~3;
529 
530 	return remaining - opts->bpf_opt_len;
531 }
532 
533 static void bpf_skops_write_hdr_opt(struct sock *sk, struct sk_buff *skb,
534 				    struct request_sock *req,
535 				    struct sk_buff *syn_skb,
536 				    enum tcp_synack_type synack_type,
537 				    struct tcp_out_options *opts)
538 {
539 	u8 first_opt_off, nr_written, max_opt_len = opts->bpf_opt_len;
540 	struct bpf_sock_ops_kern sock_ops;
541 	int err;
542 
543 	if (likely(!max_opt_len))
544 		return;
545 
546 	memset(&sock_ops, 0, offsetof(struct bpf_sock_ops_kern, temp));
547 
548 	sock_ops.op = BPF_SOCK_OPS_WRITE_HDR_OPT_CB;
549 
550 	if (req) {
551 		sock_ops.sk = (struct sock *)req;
552 		sock_ops.syn_skb = syn_skb;
553 	} else {
554 		sock_owned_by_me(sk);
555 
556 		sock_ops.is_fullsock = 1;
557 		sock_ops.is_locked_tcp_sock = 1;
558 		sock_ops.sk = sk;
559 	}
560 
561 	sock_ops.args[0] = bpf_skops_write_hdr_opt_arg0(skb, synack_type);
562 	sock_ops.remaining_opt_len = max_opt_len;
563 	first_opt_off = tcp_hdrlen(skb) - max_opt_len;
564 	bpf_skops_init_skb(&sock_ops, skb, first_opt_off);
565 
566 	err = BPF_CGROUP_RUN_PROG_SOCK_OPS_SK(&sock_ops, sk);
567 
568 	if (err)
569 		nr_written = 0;
570 	else
571 		nr_written = max_opt_len - sock_ops.remaining_opt_len;
572 
573 	if (nr_written < max_opt_len)
574 		memset(skb->data + first_opt_off + nr_written, TCPOPT_NOP,
575 		       max_opt_len - nr_written);
576 }
577 #else
578 static u32 bpf_skops_hdr_opt_len(struct sock *sk, struct sk_buff *skb,
579 				 struct request_sock *req,
580 				 struct sk_buff *syn_skb,
581 				 enum tcp_synack_type synack_type,
582 				 struct tcp_out_options *opts,
583 				 u32 remaining)
584 {
585 	return remaining;
586 }
587 
588 static void bpf_skops_write_hdr_opt(struct sock *sk, struct sk_buff *skb,
589 				    struct request_sock *req,
590 				    struct sk_buff *syn_skb,
591 				    enum tcp_synack_type synack_type,
592 				    struct tcp_out_options *opts)
593 {
594 }
595 #endif
596 
597 static __be32 *process_tcp_ao_options(struct tcp_sock *tp,
598 				      const struct tcp_request_sock *tcprsk,
599 				      struct tcp_out_options *opts,
600 				      struct tcp_key *key, __be32 *ptr)
601 {
602 #ifdef CONFIG_TCP_AO
603 	u8 maclen = tcp_ao_maclen(key->ao_key);
604 
605 	if (tcprsk) {
606 		u8 aolen = maclen + sizeof(struct tcp_ao_hdr);
607 
608 		*ptr++ = htonl((TCPOPT_AO << 24) | (aolen << 16) |
609 			       (tcprsk->ao_keyid << 8) |
610 			       (tcprsk->ao_rcv_next));
611 	} else {
612 		struct tcp_ao_key *rnext_key;
613 		struct tcp_ao_info *ao_info;
614 
615 		ao_info = rcu_dereference_check(tp->ao_info,
616 			lockdep_sock_is_held(&tp->inet_conn.icsk_inet.sk));
617 		rnext_key = READ_ONCE(ao_info->rnext_key);
618 		if (WARN_ON_ONCE(!rnext_key))
619 			return ptr;
620 		*ptr++ = htonl((TCPOPT_AO << 24) |
621 			       (tcp_ao_len(key->ao_key) << 16) |
622 			       (key->ao_key->sndid << 8) |
623 			       (rnext_key->rcvid));
624 	}
625 	opts->hash_location = (__u8 *)ptr;
626 	ptr += maclen / sizeof(*ptr);
627 	if (unlikely(maclen % sizeof(*ptr))) {
628 		memset(ptr, TCPOPT_NOP, sizeof(*ptr));
629 		ptr++;
630 	}
631 #endif
632 	return ptr;
633 }
634 
635 /* Initial values for AccECN option, ordered is based on ECN field bits
636  * similar to received_ecn_bytes. Used for SYN/ACK AccECN option.
637  */
638 static const u32 synack_ecn_bytes[3] = { 0, 0, 0 };
639 
640 /* Write previously computed TCP options to the packet.
641  *
642  * Beware: Something in the Internet is very sensitive to the ordering of
643  * TCP options, we learned this through the hard way, so be careful here.
644  * Luckily we can at least blame others for their non-compliance but from
645  * inter-operability perspective it seems that we're somewhat stuck with
646  * the ordering which we have been using if we want to keep working with
647  * those broken things (not that it currently hurts anybody as there isn't
648  * particular reason why the ordering would need to be changed).
649  *
650  * At least SACK_PERM as the first option is known to lead to a disaster
651  * (but it may well be that other scenarios fail similarly).
652  */
653 static void tcp_options_write(struct tcphdr *th, struct tcp_sock *tp,
654 			      const struct tcp_request_sock *tcprsk,
655 			      struct tcp_out_options *opts,
656 			      struct tcp_key *key)
657 {
658 	u8 leftover_highbyte = TCPOPT_NOP; /* replace 1st NOP if avail */
659 	u8 leftover_lowbyte = TCPOPT_NOP;  /* replace 2nd NOP in succession */
660 	__be32 *ptr = (__be32 *)(th + 1);
661 	u16 options = opts->options;	/* mungable copy */
662 
663 	if (tcp_key_is_md5(key)) {
664 		*ptr++ = htonl((TCPOPT_NOP << 24) | (TCPOPT_NOP << 16) |
665 			       (TCPOPT_MD5SIG << 8) | TCPOLEN_MD5SIG);
666 		/* overload cookie hash location */
667 		opts->hash_location = (__u8 *)ptr;
668 		ptr += 4;
669 	} else if (tcp_key_is_ao(key)) {
670 		ptr = process_tcp_ao_options(tp, tcprsk, opts, key, ptr);
671 	}
672 	if (unlikely(opts->mss)) {
673 		*ptr++ = htonl((TCPOPT_MSS << 24) |
674 			       (TCPOLEN_MSS << 16) |
675 			       opts->mss);
676 	}
677 
678 	if (likely(OPTION_TS & options)) {
679 		if (unlikely(OPTION_SACK_ADVERTISE & options)) {
680 			*ptr++ = htonl((TCPOPT_SACK_PERM << 24) |
681 				       (TCPOLEN_SACK_PERM << 16) |
682 				       (TCPOPT_TIMESTAMP << 8) |
683 				       TCPOLEN_TIMESTAMP);
684 			options &= ~OPTION_SACK_ADVERTISE;
685 		} else {
686 			*ptr++ = htonl((TCPOPT_NOP << 24) |
687 				       (TCPOPT_NOP << 16) |
688 				       (TCPOPT_TIMESTAMP << 8) |
689 				       TCPOLEN_TIMESTAMP);
690 		}
691 		*ptr++ = htonl(opts->tsval);
692 		*ptr++ = htonl(opts->tsecr);
693 	}
694 
695 	if (OPTION_ACCECN & options) {
696 		const u32 *ecn_bytes = opts->use_synack_ecn_bytes ?
697 				       synack_ecn_bytes :
698 				       tp->received_ecn_bytes;
699 		const u8 ect0_idx = INET_ECN_ECT_0 - 1;
700 		const u8 ect1_idx = INET_ECN_ECT_1 - 1;
701 		const u8 ce_idx = INET_ECN_CE - 1;
702 		u32 e0b;
703 		u32 e1b;
704 		u32 ceb;
705 		u8 len;
706 
707 		e0b = ecn_bytes[ect0_idx] + TCP_ACCECN_E0B_INIT_OFFSET;
708 		e1b = ecn_bytes[ect1_idx] + TCP_ACCECN_E1B_INIT_OFFSET;
709 		ceb = ecn_bytes[ce_idx] + TCP_ACCECN_CEB_INIT_OFFSET;
710 		len = TCPOLEN_ACCECN_BASE +
711 		      opts->num_accecn_fields * TCPOLEN_ACCECN_PERFIELD;
712 
713 		if (opts->num_accecn_fields == 2) {
714 			*ptr++ = htonl((TCPOPT_ACCECN1 << 24) | (len << 16) |
715 				       ((e1b >> 8) & 0xffff));
716 			*ptr++ = htonl(((e1b & 0xff) << 24) |
717 				       (ceb & 0xffffff));
718 		} else if (opts->num_accecn_fields == 1) {
719 			*ptr++ = htonl((TCPOPT_ACCECN1 << 24) | (len << 16) |
720 				       ((e1b >> 8) & 0xffff));
721 			leftover_highbyte = e1b & 0xff;
722 			leftover_lowbyte = TCPOPT_NOP;
723 		} else if (opts->num_accecn_fields == 0) {
724 			leftover_highbyte = TCPOPT_ACCECN1;
725 			leftover_lowbyte = len;
726 		} else if (opts->num_accecn_fields == 3) {
727 			*ptr++ = htonl((TCPOPT_ACCECN1 << 24) | (len << 16) |
728 				       ((e1b >> 8) & 0xffff));
729 			*ptr++ = htonl(((e1b & 0xff) << 24) |
730 				       (ceb & 0xffffff));
731 			*ptr++ = htonl(((e0b & 0xffffff) << 8) |
732 				       TCPOPT_NOP);
733 		}
734 		if (tp) {
735 			tp->accecn_minlen = 0;
736 			tp->accecn_opt_tstamp = tp->tcp_mstamp;
737 			tp->accecn_opt_sent_w_dsack = tp->rx_opt.dsack;
738 			if (tp->accecn_opt_demand)
739 				tp->accecn_opt_demand--;
740 		}
741 	} else if (tp) {
742 		tp->accecn_opt_sent_w_dsack = 0;
743 	}
744 
745 	if (unlikely(OPTION_SACK_ADVERTISE & options)) {
746 		*ptr++ = htonl((leftover_highbyte << 24) |
747 			       (leftover_lowbyte << 16) |
748 			       (TCPOPT_SACK_PERM << 8) |
749 			       TCPOLEN_SACK_PERM);
750 		leftover_highbyte = TCPOPT_NOP;
751 		leftover_lowbyte = TCPOPT_NOP;
752 	}
753 
754 	if (unlikely(OPTION_WSCALE & options)) {
755 		u8 highbyte = TCPOPT_NOP;
756 
757 		/* Do not split the leftover 2-byte to fit into a single
758 		 * NOP, i.e., replace this NOP only when 1 byte is leftover
759 		 * within leftover_highbyte.
760 		 */
761 		if (unlikely(leftover_highbyte != TCPOPT_NOP &&
762 			     leftover_lowbyte == TCPOPT_NOP)) {
763 			highbyte = leftover_highbyte;
764 			leftover_highbyte = TCPOPT_NOP;
765 		}
766 		*ptr++ = htonl((highbyte << 24) |
767 			       (TCPOPT_WINDOW << 16) |
768 			       (TCPOLEN_WINDOW << 8) |
769 			       opts->ws);
770 	}
771 
772 	if (unlikely(opts->num_sack_blocks)) {
773 		struct tcp_sack_block *sp = tp->rx_opt.dsack ?
774 			tp->duplicate_sack : tp->selective_acks;
775 		int this_sack;
776 
777 		*ptr++ = htonl((leftover_highbyte << 24) |
778 			       (leftover_lowbyte << 16) |
779 			       (TCPOPT_SACK <<  8) |
780 			       (TCPOLEN_SACK_BASE + (opts->num_sack_blocks *
781 						     TCPOLEN_SACK_PERBLOCK)));
782 		leftover_highbyte = TCPOPT_NOP;
783 		leftover_lowbyte = TCPOPT_NOP;
784 
785 		for (this_sack = 0; this_sack < opts->num_sack_blocks;
786 		     ++this_sack) {
787 			*ptr++ = htonl(sp[this_sack].start_seq);
788 			*ptr++ = htonl(sp[this_sack].end_seq);
789 		}
790 
791 		tp->rx_opt.dsack = 0;
792 	} else if (unlikely(leftover_highbyte != TCPOPT_NOP ||
793 			    leftover_lowbyte != TCPOPT_NOP)) {
794 		*ptr++ = htonl((leftover_highbyte << 24) |
795 			       (leftover_lowbyte << 16) |
796 			       (TCPOPT_NOP << 8) |
797 			       TCPOPT_NOP);
798 		leftover_highbyte = TCPOPT_NOP;
799 		leftover_lowbyte = TCPOPT_NOP;
800 	}
801 
802 	if (unlikely(OPTION_FAST_OPEN_COOKIE & options)) {
803 		struct tcp_fastopen_cookie *foc = opts->fastopen_cookie;
804 		u8 *p = (u8 *)ptr;
805 		u32 len; /* Fast Open option length */
806 
807 		if (foc->exp) {
808 			len = TCPOLEN_EXP_FASTOPEN_BASE + foc->len;
809 			*ptr = htonl((TCPOPT_EXP << 24) | (len << 16) |
810 				     TCPOPT_FASTOPEN_MAGIC);
811 			p += TCPOLEN_EXP_FASTOPEN_BASE;
812 		} else {
813 			len = TCPOLEN_FASTOPEN_BASE + foc->len;
814 			*p++ = TCPOPT_FASTOPEN;
815 			*p++ = len;
816 		}
817 
818 		memcpy(p, foc->val, foc->len);
819 		if ((len & 3) == 2) {
820 			p[foc->len] = TCPOPT_NOP;
821 			p[foc->len + 1] = TCPOPT_NOP;
822 		}
823 		ptr += (len + 3) >> 2;
824 	}
825 
826 	smc_options_write(ptr, &options);
827 
828 	mptcp_options_write(th, ptr, tp, opts);
829 }
830 
831 static void smc_set_option(struct tcp_sock *tp,
832 			   struct tcp_out_options *opts,
833 			   unsigned int *remaining)
834 {
835 #if IS_ENABLED(CONFIG_SMC)
836 	if (static_branch_unlikely(&tcp_have_smc) && tp->syn_smc) {
837 		tp->syn_smc = !!smc_call_hsbpf(1, tp, syn_option);
838 		/* re-check syn_smc */
839 		if (tp->syn_smc &&
840 		    *remaining >= TCPOLEN_EXP_SMC_BASE_ALIGNED) {
841 			opts->options |= OPTION_SMC;
842 			*remaining -= TCPOLEN_EXP_SMC_BASE_ALIGNED;
843 		}
844 	}
845 #endif
846 }
847 
848 static void smc_set_option_cond(const struct tcp_sock *tp,
849 				struct inet_request_sock *ireq,
850 				struct tcp_out_options *opts,
851 				unsigned int *remaining)
852 {
853 #if IS_ENABLED(CONFIG_SMC)
854 	if (static_branch_unlikely(&tcp_have_smc) && tp->syn_smc && ireq->smc_ok) {
855 		ireq->smc_ok = !!smc_call_hsbpf(1, tp, synack_option, ireq);
856 		/* re-check smc_ok */
857 		if (ireq->smc_ok &&
858 		    *remaining >= TCPOLEN_EXP_SMC_BASE_ALIGNED) {
859 			opts->options |= OPTION_SMC;
860 			*remaining -= TCPOLEN_EXP_SMC_BASE_ALIGNED;
861 		}
862 	}
863 #endif
864 }
865 
866 static void mptcp_set_option_cond(const struct request_sock *req,
867 				  struct tcp_out_options *opts,
868 				  unsigned int *remaining)
869 {
870 	if (rsk_is_mptcp(req)) {
871 		unsigned int size;
872 
873 		if (mptcp_synack_options(req, &size, &opts->mptcp)) {
874 			if (*remaining >= size) {
875 				opts->options |= OPTION_MPTCP;
876 				*remaining -= size;
877 			}
878 		}
879 	}
880 }
881 
882 static u32 tcp_synack_options_combine_saving(struct tcp_out_options *opts)
883 {
884 	/* How much there's room for combining with the alignment padding? */
885 	if ((opts->options & (OPTION_SACK_ADVERTISE | OPTION_TS)) ==
886 	    OPTION_SACK_ADVERTISE)
887 		return 2;
888 	else if (opts->options & OPTION_WSCALE)
889 		return 1;
890 	return 0;
891 }
892 
893 /* Calculates how long AccECN option will fit to @remaining option space.
894  *
895  * AccECN option can sometimes replace NOPs used for alignment of other
896  * TCP options (up to @max_combine_saving available).
897  *
898  * Only solutions with at least @required AccECN fields are accepted.
899  *
900  * Returns: The size of the AccECN option excluding space repurposed from
901  * the alignment of the other options.
902  */
903 static int tcp_options_fit_accecn(struct tcp_out_options *opts, int required,
904 				  int remaining)
905 {
906 	int size = TCP_ACCECN_MAXSIZE;
907 	int sack_blocks_reduce = 0;
908 	int max_combine_saving;
909 	int rem = remaining;
910 	int align_size;
911 
912 	if (opts->use_synack_ecn_bytes)
913 		max_combine_saving = tcp_synack_options_combine_saving(opts);
914 	else
915 		max_combine_saving = opts->num_sack_blocks > 0 ? 2 : 0;
916 	opts->num_accecn_fields = TCP_ACCECN_NUMFIELDS;
917 	while (opts->num_accecn_fields >= required) {
918 		/* Pad to dword if cannot combine */
919 		if ((size & 0x3) > max_combine_saving)
920 			align_size = ALIGN(size, 4);
921 		else
922 			align_size = ALIGN_DOWN(size, 4);
923 
924 		if (rem >= align_size) {
925 			size = align_size;
926 			break;
927 		} else if (opts->num_accecn_fields == required &&
928 			   opts->num_sack_blocks > 2 &&
929 			   required > 0) {
930 			/* Try to fit the option by removing one SACK block */
931 			opts->num_sack_blocks--;
932 			sack_blocks_reduce++;
933 			rem = rem + TCPOLEN_SACK_PERBLOCK;
934 
935 			opts->num_accecn_fields = TCP_ACCECN_NUMFIELDS;
936 			size = TCP_ACCECN_MAXSIZE;
937 			continue;
938 		}
939 
940 		opts->num_accecn_fields--;
941 		size -= TCPOLEN_ACCECN_PERFIELD;
942 	}
943 	if (sack_blocks_reduce > 0) {
944 		if (opts->num_accecn_fields >= required)
945 			size -= sack_blocks_reduce * TCPOLEN_SACK_PERBLOCK;
946 		else
947 			opts->num_sack_blocks += sack_blocks_reduce;
948 	}
949 	if (opts->num_accecn_fields < required)
950 		return 0;
951 
952 	opts->options |= OPTION_ACCECN;
953 	return size;
954 }
955 
956 /* Compute TCP options for SYN packets. This is not the final
957  * network wire format yet.
958  */
959 static unsigned int tcp_syn_options(struct sock *sk, struct sk_buff *skb,
960 				struct tcp_out_options *opts,
961 				struct tcp_key *key)
962 {
963 	struct tcp_sock *tp = tcp_sk(sk);
964 	unsigned int remaining = MAX_TCP_OPTION_SPACE;
965 	struct tcp_fastopen_request *fastopen = tp->fastopen_req;
966 	bool timestamps;
967 
968 	opts->options = 0;
969 
970 	/* Better than switch (key.type) as it has static branches */
971 	if (tcp_key_is_md5(key)) {
972 		timestamps = false;
973 		opts->options |= OPTION_MD5;
974 		remaining -= TCPOLEN_MD5SIG_ALIGNED;
975 	} else {
976 		timestamps = READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_timestamps);
977 		if (tcp_key_is_ao(key)) {
978 			opts->options |= OPTION_AO;
979 			remaining -= tcp_ao_len_aligned(key->ao_key);
980 		}
981 	}
982 
983 	/* We always get an MSS option.  The option bytes which will be seen in
984 	 * normal data packets should timestamps be used, must be in the MSS
985 	 * advertised.  But we subtract them from tp->mss_cache so that
986 	 * calculations in tcp_sendmsg are simpler etc.  So account for this
987 	 * fact here if necessary.  If we don't do this correctly, as a
988 	 * receiver we won't recognize data packets as being full sized when we
989 	 * should, and thus we won't abide by the delayed ACK rules correctly.
990 	 * SACKs don't matter, we never delay an ACK when we have any of those
991 	 * going out.  */
992 	opts->mss = tcp_advertise_mss(sk);
993 	remaining -= TCPOLEN_MSS_ALIGNED;
994 
995 	if (likely(timestamps)) {
996 		opts->options |= OPTION_TS;
997 		opts->tsval = tcp_skb_timestamp_ts(tp->tcp_usec_ts, skb) + tp->tsoffset;
998 		opts->tsecr = tp->rx_opt.ts_recent;
999 		remaining -= TCPOLEN_TSTAMP_ALIGNED;
1000 	}
1001 	if (likely(READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_window_scaling))) {
1002 		opts->ws = tp->rx_opt.rcv_wscale;
1003 		opts->options |= OPTION_WSCALE;
1004 		remaining -= TCPOLEN_WSCALE_ALIGNED;
1005 	}
1006 	if (likely(READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_sack))) {
1007 		opts->options |= OPTION_SACK_ADVERTISE;
1008 		if (unlikely(!(OPTION_TS & opts->options)))
1009 			remaining -= TCPOLEN_SACKPERM_ALIGNED;
1010 	}
1011 
1012 	if (fastopen && fastopen->cookie.len >= 0) {
1013 		u32 need = fastopen->cookie.len;
1014 
1015 		need += fastopen->cookie.exp ? TCPOLEN_EXP_FASTOPEN_BASE :
1016 					       TCPOLEN_FASTOPEN_BASE;
1017 		need = (need + 3) & ~3U;  /* Align to 32 bits */
1018 		if (remaining >= need) {
1019 			opts->options |= OPTION_FAST_OPEN_COOKIE;
1020 			opts->fastopen_cookie = &fastopen->cookie;
1021 			remaining -= need;
1022 			tp->syn_fastopen = 1;
1023 			tp->syn_fastopen_exp = fastopen->cookie.exp ? 1 : 0;
1024 		}
1025 	}
1026 
1027 	smc_set_option(tp, opts, &remaining);
1028 
1029 	if (sk_is_mptcp(sk)) {
1030 		unsigned int size;
1031 
1032 		if (mptcp_syn_options(sk, skb, &size, &opts->mptcp)) {
1033 			if (remaining >= size) {
1034 				opts->options |= OPTION_MPTCP;
1035 				remaining -= size;
1036 			}
1037 		}
1038 	}
1039 
1040 	/* Simultaneous open SYN/ACK needs AccECN option but not SYN.
1041 	 * It is attempted to negotiate the use of AccECN also on the first
1042 	 * retransmitted SYN, as mentioned in "3.1.4.1. Retransmitted SYNs"
1043 	 * of AccECN draft.
1044 	 */
1045 	if (unlikely((TCP_SKB_CB(skb)->tcp_flags & TCPHDR_ACK) &&
1046 		     tcp_ecn_mode_accecn(tp) &&
1047 		     inet_csk(sk)->icsk_retransmits < 2 &&
1048 		     READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_ecn_option) &&
1049 		     remaining >= TCPOLEN_ACCECN_BASE)) {
1050 		opts->use_synack_ecn_bytes = 1;
1051 		remaining -= tcp_options_fit_accecn(opts, 0, remaining);
1052 	}
1053 
1054 	remaining = bpf_skops_hdr_opt_len(sk, skb, NULL, NULL, 0, opts,
1055 					  remaining);
1056 
1057 	return MAX_TCP_OPTION_SPACE - remaining;
1058 }
1059 
1060 /* Set up TCP options for SYN-ACKs. */
1061 static unsigned int tcp_synack_options(const struct sock *sk,
1062 				       struct request_sock *req,
1063 				       unsigned int mss, struct sk_buff *skb,
1064 				       struct tcp_out_options *opts,
1065 				       const struct tcp_key *key,
1066 				       struct tcp_fastopen_cookie *foc,
1067 				       enum tcp_synack_type synack_type,
1068 				       struct sk_buff *syn_skb)
1069 {
1070 	struct inet_request_sock *ireq = inet_rsk(req);
1071 	unsigned int remaining = MAX_TCP_OPTION_SPACE;
1072 	struct tcp_request_sock *treq = tcp_rsk(req);
1073 
1074 	if (tcp_key_is_md5(key)) {
1075 		opts->options |= OPTION_MD5;
1076 		remaining -= TCPOLEN_MD5SIG_ALIGNED;
1077 
1078 		/* We can't fit any SACK blocks in a packet with MD5 + TS
1079 		 * options. There was discussion about disabling SACK
1080 		 * rather than TS in order to fit in better with old,
1081 		 * buggy kernels, but that was deemed to be unnecessary.
1082 		 */
1083 		if (synack_type != TCP_SYNACK_COOKIE)
1084 			ireq->tstamp_ok &= !ireq->sack_ok;
1085 	} else if (tcp_key_is_ao(key)) {
1086 		opts->options |= OPTION_AO;
1087 		remaining -= tcp_ao_len_aligned(key->ao_key);
1088 		ireq->tstamp_ok &= !ireq->sack_ok;
1089 	}
1090 
1091 	/* We always send an MSS option. */
1092 	opts->mss = mss;
1093 	remaining -= TCPOLEN_MSS_ALIGNED;
1094 
1095 	if (likely(ireq->wscale_ok)) {
1096 		opts->ws = ireq->rcv_wscale;
1097 		opts->options |= OPTION_WSCALE;
1098 		remaining -= TCPOLEN_WSCALE_ALIGNED;
1099 	}
1100 	if (likely(ireq->tstamp_ok)) {
1101 		opts->options |= OPTION_TS;
1102 		opts->tsval = tcp_skb_timestamp_ts(tcp_rsk(req)->req_usec_ts, skb) +
1103 			      tcp_rsk(req)->ts_off;
1104 		if (!tcp_rsk(req)->snt_tsval_first) {
1105 			if (!opts->tsval)
1106 				opts->tsval = ~0U;
1107 			tcp_rsk(req)->snt_tsval_first = opts->tsval;
1108 		}
1109 		WRITE_ONCE(tcp_rsk(req)->snt_tsval_last, opts->tsval);
1110 		opts->tsecr = req->ts_recent;
1111 		remaining -= TCPOLEN_TSTAMP_ALIGNED;
1112 	}
1113 	if (likely(ireq->sack_ok)) {
1114 		opts->options |= OPTION_SACK_ADVERTISE;
1115 		if (unlikely(!ireq->tstamp_ok))
1116 			remaining -= TCPOLEN_SACKPERM_ALIGNED;
1117 	}
1118 	if (foc != NULL && foc->len >= 0) {
1119 		u32 need = foc->len;
1120 
1121 		need += foc->exp ? TCPOLEN_EXP_FASTOPEN_BASE :
1122 				   TCPOLEN_FASTOPEN_BASE;
1123 		need = (need + 3) & ~3U;  /* Align to 32 bits */
1124 		if (remaining >= need) {
1125 			opts->options |= OPTION_FAST_OPEN_COOKIE;
1126 			opts->fastopen_cookie = foc;
1127 			remaining -= need;
1128 		}
1129 	}
1130 
1131 	mptcp_set_option_cond(req, opts, &remaining);
1132 
1133 	smc_set_option_cond(tcp_sk(sk), ireq, opts, &remaining);
1134 
1135 	if (treq->accecn_ok &&
1136 	    READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_ecn_option) &&
1137 	    synack_type != TCP_SYNACK_RETRANS && remaining >= TCPOLEN_ACCECN_BASE) {
1138 		opts->use_synack_ecn_bytes = 1;
1139 		remaining -= tcp_options_fit_accecn(opts, 0, remaining);
1140 	}
1141 
1142 	remaining = bpf_skops_hdr_opt_len((struct sock *)sk, skb, req, syn_skb,
1143 					  synack_type, opts, remaining);
1144 
1145 	return MAX_TCP_OPTION_SPACE - remaining;
1146 }
1147 
1148 /* Compute TCP options for ESTABLISHED sockets. This is not the
1149  * final wire format yet.
1150  */
1151 static unsigned int tcp_established_options(struct sock *sk, struct sk_buff *skb,
1152 					struct tcp_out_options *opts,
1153 					struct tcp_key *key)
1154 {
1155 	struct tcp_sock *tp = tcp_sk(sk);
1156 	unsigned int size = 0;
1157 	unsigned int eff_sacks;
1158 
1159 	opts->options = 0;
1160 
1161 	/* Better than switch (key.type) as it has static branches */
1162 	if (tcp_key_is_md5(key)) {
1163 		opts->options |= OPTION_MD5;
1164 		size += TCPOLEN_MD5SIG_ALIGNED;
1165 	} else if (tcp_key_is_ao(key)) {
1166 		opts->options |= OPTION_AO;
1167 		size += tcp_ao_len_aligned(key->ao_key);
1168 	}
1169 
1170 	if (likely(tp->rx_opt.tstamp_ok)) {
1171 		opts->options |= OPTION_TS;
1172 		opts->tsval = skb ? tcp_skb_timestamp_ts(tp->tcp_usec_ts, skb) +
1173 				tp->tsoffset : 0;
1174 		opts->tsecr = tp->rx_opt.ts_recent;
1175 		size += TCPOLEN_TSTAMP_ALIGNED;
1176 	}
1177 
1178 #if IS_ENABLED(CONFIG_MPTCP)
1179 	/* MPTCP options have precedence over SACK for the limited TCP
1180 	 * option space because a MPTCP connection would be forced to
1181 	 * fall back to regular TCP if a required multipath option is
1182 	 * missing. SACK still gets a chance to use whatever space is
1183 	 * left.
1184 	 */
1185 	if (sk_is_mptcp(sk)) {
1186 		unsigned int remaining = MAX_TCP_OPTION_SPACE - size;
1187 		bool has_ts = opts->options & OPTION_TS;
1188 		int opt_size;
1189 
1190 		opts->mptcp.drop_ts = 0;
1191 
1192 		opt_size = mptcp_established_options(sk, skb, remaining, has_ts,
1193 						     &opts->mptcp);
1194 		if (opt_size >= 0) {
1195 			opts->options |= OPTION_MPTCP;
1196 			size += opt_size;
1197 
1198 			if (opts->mptcp.drop_ts)
1199 				opts->options &= ~OPTION_TS;
1200 		}
1201 	}
1202 #endif
1203 
1204 	eff_sacks = tp->rx_opt.num_sacks + tp->rx_opt.dsack;
1205 	if (unlikely(eff_sacks)) {
1206 		const unsigned int remaining = MAX_TCP_OPTION_SPACE - size;
1207 		if (likely(remaining >= TCPOLEN_SACK_BASE_ALIGNED +
1208 					TCPOLEN_SACK_PERBLOCK)) {
1209 			opts->num_sack_blocks =
1210 				min_t(unsigned int, eff_sacks,
1211 				      (remaining - TCPOLEN_SACK_BASE_ALIGNED) /
1212 				      TCPOLEN_SACK_PERBLOCK);
1213 
1214 			size += TCPOLEN_SACK_BASE_ALIGNED +
1215 				opts->num_sack_blocks * TCPOLEN_SACK_PERBLOCK;
1216 		} else {
1217 			opts->num_sack_blocks = 0;
1218 		}
1219 	} else {
1220 		opts->num_sack_blocks = 0;
1221 	}
1222 
1223 	if (tcp_ecn_mode_accecn(tp)) {
1224 		int ecn_opt = READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_ecn_option);
1225 
1226 		if (ecn_opt && tp->saw_accecn_opt &&
1227 		    (ecn_opt >= TCP_ACCECN_OPTION_PERSIST ||
1228 		     !tcp_accecn_opt_fail_send(tp)) &&
1229 		    (ecn_opt >= TCP_ACCECN_OPTION_FULL || tp->accecn_opt_demand ||
1230 		     tcp_accecn_option_beacon_check(sk))) {
1231 			opts->use_synack_ecn_bytes = 0;
1232 			size += tcp_options_fit_accecn(opts, tp->accecn_minlen,
1233 						       MAX_TCP_OPTION_SPACE - size);
1234 		}
1235 	}
1236 
1237 	if (unlikely(BPF_SOCK_OPS_TEST_FLAG(tp,
1238 					    BPF_SOCK_OPS_WRITE_HDR_OPT_CB_FLAG))) {
1239 		unsigned int remaining = MAX_TCP_OPTION_SPACE - size;
1240 
1241 		remaining = bpf_skops_hdr_opt_len(sk, skb, NULL, NULL, 0, opts,
1242 						  remaining);
1243 
1244 		size = MAX_TCP_OPTION_SPACE - remaining;
1245 	}
1246 
1247 	return size;
1248 }
1249 
1250 
1251 /* TCP SMALL QUEUES (TSQ)
1252  *
1253  * TSQ goal is to keep small amount of skbs per tcp flow in tx queues (qdisc+dev)
1254  * to reduce RTT and bufferbloat.
1255  * We do this using a special skb destructor (tcp_wfree).
1256  *
1257  * Its important tcp_wfree() can be replaced by sock_wfree() in the event skb
1258  * needs to be reallocated in a driver.
1259  * The invariant being skb->truesize subtracted from sk->sk_wmem_alloc
1260  *
1261  * Since transmit from skb destructor is forbidden, we use a BH work item
1262  * to process all sockets that eventually need to send more skbs.
1263  * We use one work item per cpu, with its own queue of sockets.
1264  */
1265 struct tsq_work {
1266 	struct work_struct	work;
1267 	struct list_head	head; /* queue of tcp sockets */
1268 };
1269 static DEFINE_PER_CPU(struct tsq_work, tsq_work);
1270 
1271 static void tcp_tsq_write(struct sock *sk)
1272 {
1273 	if ((1 << sk->sk_state) &
1274 	    (TCPF_ESTABLISHED | TCPF_FIN_WAIT1 | TCPF_CLOSING |
1275 	     TCPF_CLOSE_WAIT  | TCPF_LAST_ACK)) {
1276 		struct tcp_sock *tp = tcp_sk(sk);
1277 
1278 		if (tp->lost_out > tp->retrans_out &&
1279 		    tcp_snd_cwnd(tp) > tcp_packets_in_flight(tp)) {
1280 			tcp_mstamp_refresh(tp);
1281 			tcp_xmit_retransmit_queue(sk);
1282 		}
1283 
1284 		tcp_write_xmit(sk, tcp_current_mss(sk), tp->nonagle,
1285 			       0, GFP_ATOMIC);
1286 	}
1287 }
1288 
1289 static void tcp_tsq_handler(struct sock *sk)
1290 {
1291 	bh_lock_sock(sk);
1292 	if (!sock_owned_by_user(sk))
1293 		tcp_tsq_write(sk);
1294 	else if (!test_and_set_bit(TCP_TSQ_DEFERRED, &sk->sk_tsq_flags))
1295 		sock_hold(sk);
1296 	bh_unlock_sock(sk);
1297 }
1298 /*
1299  * One work item per cpu tries to send more skbs.
1300  * We run in BH context but need to disable irqs when
1301  * transferring tsq->head because tcp_wfree() might
1302  * interrupt us (non NAPI drivers)
1303  */
1304 static void tcp_tsq_workfn(struct work_struct *work)
1305 {
1306 	struct tsq_work *tsq = container_of(work, struct tsq_work, work);
1307 	LIST_HEAD(list);
1308 	unsigned long flags;
1309 	struct list_head *q, *n;
1310 	struct tcp_sock *tp;
1311 	struct sock *sk;
1312 
1313 	local_irq_save(flags);
1314 	list_splice_init(&tsq->head, &list);
1315 	local_irq_restore(flags);
1316 
1317 	list_for_each_safe(q, n, &list) {
1318 		tp = list_entry(q, struct tcp_sock, tsq_node);
1319 		list_del(&tp->tsq_node);
1320 
1321 		sk = (struct sock *)tp;
1322 		smp_mb__before_atomic();
1323 		clear_bit(TSQ_QUEUED, &sk->sk_tsq_flags);
1324 
1325 		tcp_tsq_handler(sk);
1326 		sk_free(sk);
1327 	}
1328 }
1329 
1330 /**
1331  * tcp_release_cb - tcp release_sock() callback
1332  * @sk: socket
1333  *
1334  * called from release_sock() to perform protocol dependent
1335  * actions before socket release.
1336  */
1337 void tcp_release_cb(struct sock *sk)
1338 {
1339 	unsigned long flags = smp_load_acquire(&sk->sk_tsq_flags);
1340 	unsigned long nflags;
1341 
1342 	/* perform an atomic operation only if at least one flag is set */
1343 	do {
1344 		if (!(flags & TCP_DEFERRED_ALL))
1345 			return;
1346 		nflags = flags & ~TCP_DEFERRED_ALL;
1347 	} while (!try_cmpxchg(&sk->sk_tsq_flags, &flags, nflags));
1348 
1349 	if (flags & TCPF_TSQ_DEFERRED) {
1350 		tcp_tsq_write(sk);
1351 		__sock_put(sk);
1352 	}
1353 
1354 	if (flags & TCPF_WRITE_TIMER_DEFERRED) {
1355 		tcp_write_timer_handler(sk);
1356 		__sock_put(sk);
1357 	}
1358 	if (flags & TCPF_DELACK_TIMER_DEFERRED) {
1359 		tcp_delack_timer_handler(sk);
1360 		__sock_put(sk);
1361 	}
1362 	if (flags & TCPF_MTU_REDUCED_DEFERRED) {
1363 		inet_csk(sk)->icsk_af_ops->mtu_reduced(sk);
1364 		__sock_put(sk);
1365 	}
1366 	if ((flags & TCPF_ACK_DEFERRED) && inet_csk_ack_scheduled(sk))
1367 		tcp_send_ack(sk);
1368 }
1369 
1370 void __init tcp_tsq_work_init(void)
1371 {
1372 	int i;
1373 
1374 	for_each_possible_cpu(i) {
1375 		struct tsq_work *tsq = &per_cpu(tsq_work, i);
1376 
1377 		INIT_LIST_HEAD(&tsq->head);
1378 		INIT_WORK(&tsq->work, tcp_tsq_workfn);
1379 	}
1380 }
1381 
1382 /*
1383  * Write buffer destructor automatically called from kfree_skb.
1384  * We can't xmit new skbs from this context, as we might already
1385  * hold qdisc lock.
1386  */
1387 void tcp_wfree(struct sk_buff *skb)
1388 {
1389 	struct sock *sk = skb->sk;
1390 	struct tcp_sock *tp = tcp_sk(sk);
1391 	unsigned long flags, nval, oval;
1392 	struct tsq_work *tsq;
1393 	bool empty;
1394 
1395 	/* Keep one reference on sk_wmem_alloc.
1396 	 * Will be released by sk_free() from here or tcp_tsq_workfn()
1397 	 */
1398 	WARN_ON(refcount_sub_and_test(skb->truesize - 1, &sk->sk_wmem_alloc));
1399 
1400 	/* If this softirq is serviced by ksoftirqd, we are likely under stress.
1401 	 * Wait until our queues (qdisc + devices) are drained.
1402 	 * This gives :
1403 	 * - less callbacks to tcp_write_xmit(), reducing stress (batches)
1404 	 * - chance for incoming ACK (processed by another cpu maybe)
1405 	 *   to migrate this flow (skb->ooo_okay will be eventually set)
1406 	 */
1407 	if (refcount_read(&sk->sk_wmem_alloc) >= SKB_TRUESIZE(1) && this_cpu_ksoftirqd() == current)
1408 		goto out;
1409 
1410 	oval = smp_load_acquire(&sk->sk_tsq_flags);
1411 	do {
1412 		if (!(oval & TSQF_THROTTLED) || (oval & TSQF_QUEUED))
1413 			goto out;
1414 
1415 		nval = (oval & ~TSQF_THROTTLED) | TSQF_QUEUED;
1416 	} while (!try_cmpxchg(&sk->sk_tsq_flags, &oval, nval));
1417 
1418 	/* queue this socket to BH workqueue */
1419 	local_irq_save(flags);
1420 	tsq = this_cpu_ptr(&tsq_work);
1421 	empty = list_empty(&tsq->head);
1422 	list_add(&tp->tsq_node, &tsq->head);
1423 	if (empty)
1424 		queue_work(system_bh_wq, &tsq->work);
1425 	local_irq_restore(flags);
1426 	return;
1427 out:
1428 	sk_free(sk);
1429 }
1430 EXPORT_SYMBOL_GPL(tcp_wfree);
1431 
1432 /* Note: Called under soft irq.
1433  * We can call TCP stack right away, unless socket is owned by user.
1434  */
1435 enum hrtimer_restart tcp_pace_kick(struct hrtimer *timer)
1436 {
1437 	struct tcp_sock *tp = container_of(timer, struct tcp_sock, pacing_timer);
1438 	struct sock *sk = (struct sock *)tp;
1439 
1440 	tcp_tsq_handler(sk);
1441 	sock_put(sk);
1442 
1443 	return HRTIMER_NORESTART;
1444 }
1445 
1446 static void tcp_update_skb_after_send(struct sock *sk, struct sk_buff *skb,
1447 				      u64 prior_wstamp)
1448 {
1449 	struct tcp_sock *tp = tcp_sk(sk);
1450 
1451 	if (sk->sk_pacing_status != SK_PACING_NONE) {
1452 		unsigned long rate = READ_ONCE(sk->sk_pacing_rate);
1453 
1454 		/* Original sch_fq does not pace first 10 MSS
1455 		 * Note that tp->data_segs_out overflows after 2^32 packets,
1456 		 * this is a minor annoyance.
1457 		 */
1458 		if (rate != ~0UL && rate && tp->data_segs_out >= 10) {
1459 			u64 len_ns = div64_ul((u64)skb->len * NSEC_PER_SEC, rate);
1460 			u64 credit = tp->tcp_wstamp_ns - prior_wstamp;
1461 
1462 			/* take into account OS jitter */
1463 			len_ns -= min_t(u64, len_ns / 2, credit);
1464 			tp->tcp_wstamp_ns += len_ns;
1465 		}
1466 	}
1467 	list_move_tail(&skb->tcp_tsorted_anchor, &tp->tsorted_sent_queue);
1468 }
1469 
1470 /* Snapshot the current delivery information in the skb, to generate
1471  * a rate sample later when the skb is (s)acked in tcp_rate_skb_delivered().
1472  */
1473 static void tcp_rate_skb_sent(struct sock *sk, struct sk_buff *skb)
1474 {
1475 	struct tcp_sock *tp = tcp_sk(sk);
1476 
1477 	 /* In general we need to start delivery rate samples from the
1478 	  * time we received the most recent ACK, to ensure we include
1479 	  * the full time the network needs to deliver all in-flight
1480 	  * packets. If there are no packets in flight yet, then we
1481 	  * know that any ACKs after now indicate that the network was
1482 	  * able to deliver those packets completely in the sampling
1483 	  * interval between now and the next ACK.
1484 	  *
1485 	  * Note that we use packets_out instead of tcp_packets_in_flight(tp)
1486 	  * because the latter is a guess based on RTO and loss-marking
1487 	  * heuristics. We don't want spurious RTOs or loss markings to cause
1488 	  * a spuriously small time interval, causing a spuriously high
1489 	  * bandwidth estimate.
1490 	  */
1491 	if (!tp->packets_out) {
1492 		u64 tstamp_us = tcp_skb_timestamp_us(skb);
1493 
1494 		tp->first_tx_mstamp  = tstamp_us;
1495 		tp->delivered_mstamp = tstamp_us;
1496 	}
1497 
1498 	TCP_SKB_CB(skb)->tx.first_tx_mstamp	= tp->first_tx_mstamp;
1499 	TCP_SKB_CB(skb)->tx.delivered_mstamp	= tp->delivered_mstamp;
1500 	TCP_SKB_CB(skb)->tx.delivered		= tp->delivered;
1501 	TCP_SKB_CB(skb)->tx.delivered_ce	= tp->delivered_ce;
1502 	TCP_SKB_CB(skb)->tx.is_app_limited	= tp->app_limited ? 1 : 0;
1503 }
1504 
1505 INDIRECT_CALLABLE_DECLARE(int ip_queue_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl));
1506 INDIRECT_CALLABLE_DECLARE(int inet6_csk_xmit(struct sock *sk, struct sk_buff *skb, struct flowi *fl));
1507 
1508 /* This routine computes an IPv4 TCP checksum. */
1509 static void tcp_v4_send_check(struct sock *sk, struct sk_buff *skb)
1510 {
1511 	const struct inet_sock *inet = inet_sk(sk);
1512 
1513 	__tcp_v4_send_check(skb, inet->inet_saddr, inet->inet_daddr);
1514 }
1515 
1516 #if IS_ENABLED(CONFIG_IPV6)
1517 #include <net/ip6_checksum.h>
1518 
1519 static void tcp_v6_send_check(struct sock *sk, struct sk_buff *skb)
1520 {
1521 	__tcp_v6_send_check(skb, &sk->sk_v6_rcv_saddr, &sk->sk_v6_daddr);
1522 }
1523 #endif
1524 
1525 /* This routine actually transmits TCP packets queued in by
1526  * tcp_do_sendmsg().  This is used by both the initial
1527  * transmission and possible later retransmissions.
1528  * All SKB's seen here are completely headerless.  It is our
1529  * job to build the TCP header, and pass the packet down to
1530  * IP so it can do the same plus pass the packet off to the
1531  * device.
1532  *
1533  * We are working here with either a clone of the original
1534  * SKB, or a fresh unique copy made by the retransmit engine.
1535  */
1536 static int __tcp_transmit_skb(struct sock *sk, struct sk_buff *skb,
1537 			      int clone_it, gfp_t gfp_mask, u32 rcv_nxt)
1538 {
1539 	const struct inet_connection_sock *icsk = inet_csk(sk);
1540 	struct inet_sock *inet;
1541 	struct tcp_sock *tp;
1542 	struct tcp_skb_cb *tcb;
1543 	struct tcp_out_options opts;
1544 	unsigned int tcp_options_size, tcp_header_size;
1545 	struct sk_buff *oskb = NULL;
1546 	struct tcp_key key;
1547 	struct tcphdr *th;
1548 	u64 prior_wstamp;
1549 	int err;
1550 
1551 	BUG_ON(!skb || !tcp_skb_pcount(skb));
1552 	tp = tcp_sk(sk);
1553 	prior_wstamp = tp->tcp_wstamp_ns;
1554 	tp->tcp_wstamp_ns = max(tp->tcp_wstamp_ns, tp->tcp_clock_cache);
1555 	skb_set_delivery_time(skb, tp->tcp_wstamp_ns, SKB_CLOCK_MONOTONIC);
1556 	if (clone_it) {
1557 		oskb = skb;
1558 
1559 		tcp_skb_tsorted_save(oskb) {
1560 			if (unlikely(skb_cloned(oskb)))
1561 				skb = pskb_copy(oskb, gfp_mask);
1562 			else
1563 				skb = skb_clone(oskb, gfp_mask);
1564 		} tcp_skb_tsorted_restore(oskb);
1565 
1566 		if (unlikely(!skb))
1567 			return -ENOBUFS;
1568 		/* retransmit skbs might have a non zero value in skb->dev
1569 		 * because skb->dev is aliased with skb->rbnode.rb_left
1570 		 */
1571 		skb->dev = NULL;
1572 	}
1573 
1574 	inet = inet_sk(sk);
1575 	tcb = TCP_SKB_CB(skb);
1576 	memset(&opts.cleared, 0, sizeof(opts.cleared));
1577 
1578 	tcp_get_current_key(sk, &key);
1579 	if (unlikely(tcb->tcp_flags & TCPHDR_SYN)) {
1580 		tcp_options_size = tcp_syn_options(sk, skb, &opts, &key);
1581 	} else {
1582 		tcp_options_size = tcp_established_options(sk, skb, &opts, &key);
1583 		/* Force a PSH flag on all (GSO) packets to expedite GRO flush
1584 		 * at receiver : This slightly improve GRO performance.
1585 		 * Note that we do not force the PSH flag for non GSO packets,
1586 		 * because they might be sent under high congestion events,
1587 		 * and in this case it is better to delay the delivery of 1-MSS
1588 		 * packets and thus the corresponding ACK packet that would
1589 		 * release the following packet.
1590 		 */
1591 		if (tcp_skb_pcount(skb) > 1)
1592 			tcb->tcp_flags |= TCPHDR_PSH;
1593 	}
1594 	tcp_header_size = tcp_options_size + sizeof(struct tcphdr);
1595 
1596 	/* We set skb->ooo_okay to one if this packet can select
1597 	 * a different TX queue than prior packets of this flow,
1598 	 * to avoid self inflicted reorders.
1599 	 * The 'other' queue decision is based on current cpu number
1600 	 * if XPS is enabled, or sk->sk_txhash otherwise.
1601 	 * We can switch to another (and better) queue if:
1602 	 * 1) No packet with payload is in qdisc/device queues.
1603 	 *    Delays in TX completion can defeat the test
1604 	 *    even if packets were already sent.
1605 	 * 2) Or rtx queue is empty.
1606 	 *    This mitigates above case if ACK packets for
1607 	 *    all prior packets were already processed.
1608 	 */
1609 	skb->ooo_okay = sk_wmem_alloc_get(sk) < SKB_TRUESIZE(1) ||
1610 			tcp_rtx_queue_empty(sk);
1611 
1612 	/* If we had to use memory reserve to allocate this skb,
1613 	 * this might cause drops if packet is looped back :
1614 	 * Other socket might not have SOCK_MEMALLOC.
1615 	 * Packets not looped back do not care about pfmemalloc.
1616 	 */
1617 	skb->pfmemalloc = 0;
1618 
1619 	__skb_push(skb, tcp_header_size);
1620 	skb_reset_transport_header(skb);
1621 
1622 	skb_orphan(skb);
1623 	skb->sk = sk;
1624 	skb->destructor = skb_is_tcp_pure_ack(skb) ? __sock_wfree : tcp_wfree;
1625 	refcount_add(skb->truesize, &sk->sk_wmem_alloc);
1626 
1627 	skb_set_dst_pending_confirm(skb, READ_ONCE(sk->sk_dst_pending_confirm));
1628 
1629 	/* Build TCP header and checksum it. */
1630 	th = (struct tcphdr *)skb->data;
1631 	th->source		= inet->inet_sport;
1632 	th->dest		= inet->inet_dport;
1633 	th->seq			= htonl(tcb->seq);
1634 	th->ack_seq		= htonl(rcv_nxt);
1635 	*(((__be16 *)th) + 6)	= htons(((tcp_header_size >> 2) << 12) |
1636 					(tcb->tcp_flags & TCPHDR_FLAGS_MASK));
1637 
1638 	th->check		= 0;
1639 	th->urg_ptr		= 0;
1640 
1641 	/* The urg_mode check is necessary during a below snd_una win probe */
1642 	if (unlikely(tcp_urg_mode(tp) && before(tcb->seq, tp->snd_up))) {
1643 		if (before(tp->snd_up, tcb->seq + 0x10000)) {
1644 			th->urg_ptr = htons(tp->snd_up - tcb->seq);
1645 			th->urg = 1;
1646 		} else if (after(tcb->seq + 0xFFFF, tp->snd_nxt)) {
1647 			th->urg_ptr = htons(0xFFFF);
1648 			th->urg = 1;
1649 		}
1650 	}
1651 
1652 	skb_shinfo(skb)->gso_type = sk->sk_gso_type;
1653 	if (likely(!(tcb->tcp_flags & TCPHDR_SYN))) {
1654 		th->window      = htons(tcp_select_window(sk));
1655 		tcp_ecn_send(sk, skb, th, tcp_header_size);
1656 	} else {
1657 		/* RFC1323: The window in SYN & SYN/ACK segments
1658 		 * is never scaled.
1659 		 */
1660 		th->window	= htons(min(tp->rcv_wnd, 65535U));
1661 	}
1662 
1663 	tcp_options_write(th, tp, NULL, &opts, &key);
1664 
1665 	if (tcp_key_is_md5(&key)) {
1666 #ifdef CONFIG_TCP_MD5SIG
1667 		/* Calculate the MD5 hash, as we have all we need now */
1668 		sk_gso_disable(sk);
1669 		tp->af_specific->calc_md5_hash(opts.hash_location,
1670 					       key.md5_key, sk, skb);
1671 #endif
1672 	} else if (tcp_key_is_ao(&key)) {
1673 		tcp_ao_transmit_skb(sk, skb, key.ao_key, th,
1674 				    opts.hash_location);
1675 	}
1676 
1677 	/* BPF prog is the last one writing header option */
1678 	bpf_skops_write_hdr_opt(sk, skb, NULL, NULL, 0, &opts);
1679 
1680 #if IS_ENABLED(CONFIG_IPV6)
1681 	if (likely(icsk->icsk_af_ops->net_header_len == sizeof(struct ipv6hdr)))
1682 		tcp_v6_send_check(sk, skb);
1683 	else
1684 #endif
1685 		tcp_v4_send_check(sk, skb);
1686 
1687 	if (likely(tcb->tcp_flags & TCPHDR_ACK))
1688 		tcp_event_ack_sent(sk, rcv_nxt);
1689 
1690 	if (skb->len != tcp_header_size) {
1691 		tcp_event_data_sent(tp, sk);
1692 		WRITE_ONCE(tp->data_segs_out,
1693 			   tp->data_segs_out + tcp_skb_pcount(skb));
1694 		WRITE_ONCE(tp->bytes_sent,
1695 			   tp->bytes_sent + skb->len - tcp_header_size);
1696 	}
1697 
1698 	if (after(tcb->end_seq, tp->snd_nxt) || tcb->seq == tcb->end_seq)
1699 		TCP_ADD_STATS(sock_net(sk), TCP_MIB_OUTSEGS,
1700 			      tcp_skb_pcount(skb));
1701 
1702 	tp->segs_out += tcp_skb_pcount(skb);
1703 	skb_set_hash_from_sk(skb, sk);
1704 	/* OK, its time to fill skb_shinfo(skb)->gso_{segs|size} */
1705 	skb_shinfo(skb)->gso_segs = tcp_skb_pcount(skb);
1706 	skb_shinfo(skb)->gso_size = tcp_skb_mss(skb);
1707 
1708 	/* Leave earliest departure time in skb->tstamp (skb->skb_mstamp_ns) */
1709 
1710 	/* Cleanup our debris for IP stacks */
1711 	memset(skb->cb, 0, max(sizeof(struct inet_skb_parm),
1712 			       sizeof(struct inet6_skb_parm)));
1713 
1714 	tcp_add_tx_delay(skb, tp);
1715 
1716 	err = INDIRECT_CALL_INET(icsk->icsk_af_ops->queue_xmit,
1717 				 inet6_csk_xmit, ip_queue_xmit,
1718 				 sk, skb, &inet->cork.fl);
1719 
1720 	if (unlikely(err > 0)) {
1721 		tcp_enter_cwr(sk);
1722 		err = net_xmit_eval(err);
1723 	}
1724 	if (!err && oskb) {
1725 		tcp_update_skb_after_send(sk, oskb, prior_wstamp);
1726 		tcp_rate_skb_sent(sk, oskb);
1727 	}
1728 	return err;
1729 }
1730 
1731 static int tcp_transmit_skb(struct sock *sk, struct sk_buff *skb, int clone_it,
1732 			    gfp_t gfp_mask)
1733 {
1734 	return __tcp_transmit_skb(sk, skb, clone_it, gfp_mask,
1735 				  tcp_sk(sk)->rcv_nxt);
1736 }
1737 
1738 /* This routine just queues the buffer for sending.
1739  *
1740  * NOTE: probe0 timer is not checked, do not forget tcp_push_pending_frames,
1741  * otherwise socket can stall.
1742  */
1743 static void tcp_queue_skb(struct sock *sk, struct sk_buff *skb)
1744 {
1745 	struct tcp_sock *tp = tcp_sk(sk);
1746 
1747 	/* Advance write_seq and place onto the write_queue. */
1748 	WRITE_ONCE(tp->write_seq, TCP_SKB_CB(skb)->end_seq);
1749 	__skb_header_release(skb);
1750 	psp_enqueue_set_decrypted(sk, skb);
1751 	tcp_add_write_queue_tail(sk, skb);
1752 	sk_wmem_queued_add(sk, skb->truesize);
1753 	sk_mem_charge(sk, skb->truesize);
1754 }
1755 
1756 /* Initialize TSO segments for a packet. */
1757 static int tcp_set_skb_tso_segs(struct sk_buff *skb, unsigned int mss_now)
1758 {
1759 	int tso_segs;
1760 
1761 	if (skb->len <= mss_now) {
1762 		/* Avoid the costly divide in the normal
1763 		 * non-TSO case.
1764 		 */
1765 		TCP_SKB_CB(skb)->tcp_gso_size = 0;
1766 		tcp_skb_pcount_set(skb, 1);
1767 		return 1;
1768 	}
1769 	TCP_SKB_CB(skb)->tcp_gso_size = mss_now;
1770 	tso_segs = DIV_ROUND_UP(skb->len, mss_now);
1771 	tcp_skb_pcount_set(skb, tso_segs);
1772 	return tso_segs;
1773 }
1774 
1775 /* Pcount in the middle of the write queue got changed, we need to do various
1776  * tweaks to fix counters
1777  */
1778 static void tcp_adjust_pcount(struct sock *sk, const struct sk_buff *skb, int decr)
1779 {
1780 	struct tcp_sock *tp = tcp_sk(sk);
1781 
1782 	tp->packets_out -= decr;
1783 
1784 	if (TCP_SKB_CB(skb)->sacked & TCPCB_SACKED_ACKED)
1785 		tp->sacked_out -= decr;
1786 	if (TCP_SKB_CB(skb)->sacked & TCPCB_SACKED_RETRANS)
1787 		tp->retrans_out -= decr;
1788 	if (TCP_SKB_CB(skb)->sacked & TCPCB_LOST)
1789 		tp->lost_out -= decr;
1790 
1791 	/* Reno case is special. Sigh... */
1792 	if (tcp_is_reno(tp) && decr > 0)
1793 		tp->sacked_out -= min_t(u32, tp->sacked_out, decr);
1794 
1795 	tcp_verify_left_out(tp);
1796 }
1797 
1798 static bool tcp_has_tx_tstamp(const struct sk_buff *skb)
1799 {
1800 	return TCP_SKB_CB(skb)->txstamp_ack ||
1801 		(skb_shinfo(skb)->tx_flags & SKBTX_ANY_TSTAMP);
1802 }
1803 
1804 static void tcp_fragment_tstamp(struct sk_buff *skb, struct sk_buff *skb2)
1805 {
1806 	struct skb_shared_info *shinfo = skb_shinfo(skb);
1807 
1808 	if (unlikely(tcp_has_tx_tstamp(skb)) &&
1809 	    !before(shinfo->tskey, TCP_SKB_CB(skb2)->seq)) {
1810 		struct skb_shared_info *shinfo2 = skb_shinfo(skb2);
1811 		u8 tsflags = shinfo->tx_flags & SKBTX_ANY_TSTAMP;
1812 
1813 		shinfo->tx_flags &= ~tsflags;
1814 		shinfo2->tx_flags |= tsflags;
1815 		swap(shinfo->tskey, shinfo2->tskey);
1816 		TCP_SKB_CB(skb2)->txstamp_ack = TCP_SKB_CB(skb)->txstamp_ack;
1817 		TCP_SKB_CB(skb)->txstamp_ack = 0;
1818 	}
1819 }
1820 
1821 static void tcp_skb_fragment_eor(struct sk_buff *skb, struct sk_buff *skb2)
1822 {
1823 	TCP_SKB_CB(skb2)->eor = TCP_SKB_CB(skb)->eor;
1824 	TCP_SKB_CB(skb)->eor = 0;
1825 }
1826 
1827 /* Insert buff after skb on the write or rtx queue of sk.  */
1828 static void tcp_insert_write_queue_after(struct sk_buff *skb,
1829 					 struct sk_buff *buff,
1830 					 struct sock *sk,
1831 					 enum tcp_queue tcp_queue)
1832 {
1833 	if (tcp_queue == TCP_FRAG_IN_WRITE_QUEUE)
1834 		__skb_queue_after(&sk->sk_write_queue, skb, buff);
1835 	else
1836 		tcp_rbtree_insert(&sk->tcp_rtx_queue, buff);
1837 }
1838 
1839 /* Function to create two new TCP segments.  Shrinks the given segment
1840  * to the specified size and appends a new segment with the rest of the
1841  * packet to the list.  This won't be called frequently, I hope.
1842  * Remember, these are still headerless SKBs at this point.
1843  */
1844 int tcp_fragment(struct sock *sk, enum tcp_queue tcp_queue,
1845 		 struct sk_buff *skb, u32 len,
1846 		 unsigned int mss_now, gfp_t gfp)
1847 {
1848 	struct tcp_sock *tp = tcp_sk(sk);
1849 	struct sk_buff *buff;
1850 	int old_factor;
1851 	long limit;
1852 	u16 flags;
1853 	int nlen;
1854 
1855 	if (WARN_ON(len > skb->len))
1856 		return -EINVAL;
1857 
1858 	DEBUG_NET_WARN_ON_ONCE(skb_headlen(skb));
1859 
1860 	/* tcp_sendmsg() can overshoot sk_wmem_queued by one full size skb.
1861 	 * We need some allowance to not penalize applications setting small
1862 	 * SO_SNDBUF values.
1863 	 * Also allow first and last skb in retransmit queue to be split.
1864 	 */
1865 	limit = sk->sk_sndbuf + 2 * SKB_TRUESIZE(GSO_LEGACY_MAX_SIZE);
1866 	if (unlikely((sk->sk_wmem_queued >> 1) > limit &&
1867 		     tcp_queue != TCP_FRAG_IN_WRITE_QUEUE &&
1868 		     skb != tcp_rtx_queue_head(sk) &&
1869 		     skb != tcp_rtx_queue_tail(sk))) {
1870 		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPWQUEUETOOBIG);
1871 		return -ENOMEM;
1872 	}
1873 
1874 	if (skb_unclone_keeptruesize(skb, gfp))
1875 		return -ENOMEM;
1876 
1877 	/* Get a new skb... force flag on. */
1878 	buff = tcp_stream_alloc_skb(sk, gfp, true);
1879 	if (!buff)
1880 		return -ENOMEM; /* We'll just try again later. */
1881 	skb_copy_decrypted(buff, skb);
1882 	mptcp_skb_ext_copy(buff, skb);
1883 
1884 	sk_wmem_queued_add(sk, buff->truesize);
1885 	sk_mem_charge(sk, buff->truesize);
1886 	nlen = skb->len - len;
1887 	buff->truesize += nlen;
1888 	skb->truesize -= nlen;
1889 
1890 	/* Correct the sequence numbers. */
1891 	TCP_SKB_CB(buff)->seq = TCP_SKB_CB(skb)->seq + len;
1892 	TCP_SKB_CB(buff)->end_seq = TCP_SKB_CB(skb)->end_seq;
1893 	TCP_SKB_CB(skb)->end_seq = TCP_SKB_CB(buff)->seq;
1894 
1895 	/* PSH and FIN should only be set in the second packet. */
1896 	flags = TCP_SKB_CB(skb)->tcp_flags;
1897 	TCP_SKB_CB(skb)->tcp_flags = flags & ~(TCPHDR_FIN | TCPHDR_PSH);
1898 	TCP_SKB_CB(buff)->tcp_flags = flags;
1899 	TCP_SKB_CB(buff)->sacked = TCP_SKB_CB(skb)->sacked;
1900 	tcp_skb_fragment_eor(skb, buff);
1901 
1902 	skb_split(skb, buff, len);
1903 
1904 	skb_set_delivery_time(buff, skb->tstamp, SKB_CLOCK_MONOTONIC);
1905 	tcp_fragment_tstamp(skb, buff);
1906 
1907 	old_factor = tcp_skb_pcount(skb);
1908 
1909 	/* Fix up tso_factor for both original and new SKB.  */
1910 	tcp_set_skb_tso_segs(skb, mss_now);
1911 	tcp_set_skb_tso_segs(buff, mss_now);
1912 
1913 	/* Update delivered info for the new segment */
1914 	TCP_SKB_CB(buff)->tx = TCP_SKB_CB(skb)->tx;
1915 
1916 	/* If this packet has been sent out already, we must
1917 	 * adjust the various packet counters.
1918 	 */
1919 	if (!before(tp->snd_nxt, TCP_SKB_CB(buff)->end_seq)) {
1920 		int diff = old_factor - tcp_skb_pcount(skb) -
1921 			tcp_skb_pcount(buff);
1922 
1923 		if (diff)
1924 			tcp_adjust_pcount(sk, skb, diff);
1925 	}
1926 
1927 	/* Link BUFF into the send queue. */
1928 	__skb_header_release(buff);
1929 	tcp_insert_write_queue_after(skb, buff, sk, tcp_queue);
1930 	if (tcp_queue == TCP_FRAG_IN_RTX_QUEUE)
1931 		list_add(&buff->tcp_tsorted_anchor, &skb->tcp_tsorted_anchor);
1932 
1933 	return 0;
1934 }
1935 
1936 /* This is similar to __pskb_pull_tail(). The difference is that pulled
1937  * data is not copied, but immediately discarded.
1938  */
1939 static int __pskb_trim_head(struct sk_buff *skb, int len)
1940 {
1941 	struct skb_shared_info *shinfo;
1942 	int i, k, eat;
1943 
1944 	DEBUG_NET_WARN_ON_ONCE(skb_headlen(skb));
1945 	eat = len;
1946 	k = 0;
1947 	shinfo = skb_shinfo(skb);
1948 	for (i = 0; i < shinfo->nr_frags; i++) {
1949 		int size = skb_frag_size(&shinfo->frags[i]);
1950 
1951 		if (size <= eat) {
1952 			skb_frag_unref(skb, i);
1953 			eat -= size;
1954 		} else {
1955 			shinfo->frags[k] = shinfo->frags[i];
1956 			if (eat) {
1957 				skb_frag_off_add(&shinfo->frags[k], eat);
1958 				skb_frag_size_sub(&shinfo->frags[k], eat);
1959 				eat = 0;
1960 			}
1961 			k++;
1962 		}
1963 	}
1964 	shinfo->nr_frags = k;
1965 
1966 	skb->data_len -= len;
1967 	skb->len = skb->data_len;
1968 	return len;
1969 }
1970 
1971 /* Remove acked data from a packet in the transmit queue. */
1972 int tcp_trim_head(struct sock *sk, struct sk_buff *skb, u32 len)
1973 {
1974 	u32 delta_truesize;
1975 
1976 	if (skb_unclone_keeptruesize(skb, GFP_ATOMIC))
1977 		return -ENOMEM;
1978 
1979 	delta_truesize = __pskb_trim_head(skb, len);
1980 
1981 	TCP_SKB_CB(skb)->seq += len;
1982 
1983 	skb->truesize	   -= delta_truesize;
1984 	sk_wmem_queued_add(sk, -delta_truesize);
1985 	if (!skb_zcopy_pure(skb))
1986 		sk_mem_uncharge(sk, delta_truesize);
1987 
1988 	/* Any change of skb->len requires recalculation of tso factor. */
1989 	if (tcp_skb_pcount(skb) > 1)
1990 		tcp_set_skb_tso_segs(skb, tcp_skb_mss(skb));
1991 
1992 	return 0;
1993 }
1994 
1995 /* Calculate MSS not accounting any TCP options.  */
1996 static inline int __tcp_mtu_to_mss(struct sock *sk, int pmtu)
1997 {
1998 	const struct tcp_sock *tp = tcp_sk(sk);
1999 	const struct inet_connection_sock *icsk = inet_csk(sk);
2000 	int mss_now;
2001 
2002 	/* Calculate base mss without TCP options:
2003 	   It is MMS_S - sizeof(tcphdr) of rfc1122
2004 	 */
2005 	mss_now = pmtu - icsk->icsk_af_ops->net_header_len - sizeof(struct tcphdr);
2006 
2007 	/* Clamp it (mss_clamp does not include tcp options) */
2008 	if (mss_now > tp->rx_opt.mss_clamp)
2009 		mss_now = tp->rx_opt.mss_clamp;
2010 
2011 	/* Now subtract optional transport overhead */
2012 	mss_now -= icsk->icsk_ext_hdr_len;
2013 
2014 	/* Then reserve room for full set of TCP options and 8 bytes of data */
2015 	mss_now = max(mss_now,
2016 		      READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_min_snd_mss));
2017 	return mss_now;
2018 }
2019 
2020 /* Calculate MSS. Not accounting for SACKs here.  */
2021 int tcp_mtu_to_mss(struct sock *sk, int pmtu)
2022 {
2023 	/* Subtract TCP options size, not including SACKs */
2024 	return __tcp_mtu_to_mss(sk, pmtu) -
2025 	       (tcp_sk(sk)->tcp_header_len - sizeof(struct tcphdr));
2026 }
2027 
2028 /* Inverse of above */
2029 int tcp_mss_to_mtu(struct sock *sk, int mss)
2030 {
2031 	const struct tcp_sock *tp = tcp_sk(sk);
2032 	const struct inet_connection_sock *icsk = inet_csk(sk);
2033 
2034 	return mss +
2035 	      tp->tcp_header_len +
2036 	      icsk->icsk_ext_hdr_len +
2037 	      icsk->icsk_af_ops->net_header_len;
2038 }
2039 EXPORT_SYMBOL(tcp_mss_to_mtu);
2040 
2041 /* MTU probing init per socket */
2042 void tcp_mtup_init(struct sock *sk)
2043 {
2044 	struct tcp_sock *tp = tcp_sk(sk);
2045 	struct inet_connection_sock *icsk = inet_csk(sk);
2046 	struct net *net = sock_net(sk);
2047 
2048 	icsk->icsk_mtup.enabled = READ_ONCE(net->ipv4.sysctl_tcp_mtu_probing) > 1;
2049 	icsk->icsk_mtup.search_high = tp->rx_opt.mss_clamp + sizeof(struct tcphdr) +
2050 			       icsk->icsk_af_ops->net_header_len;
2051 	icsk->icsk_mtup.search_low = tcp_mss_to_mtu(sk, READ_ONCE(net->ipv4.sysctl_tcp_base_mss));
2052 	icsk->icsk_mtup.probe_size = 0;
2053 	if (icsk->icsk_mtup.enabled)
2054 		icsk->icsk_mtup.probe_timestamp = tcp_jiffies32;
2055 }
2056 
2057 /* This function synchronize snd mss to current pmtu/exthdr set.
2058 
2059    tp->rx_opt.user_mss is mss set by user by TCP_MAXSEG. It does NOT counts
2060    for TCP options, but includes only bare TCP header.
2061 
2062    tp->rx_opt.mss_clamp is mss negotiated at connection setup.
2063    It is minimum of user_mss and mss received with SYN.
2064    It also does not include TCP options.
2065 
2066    inet_csk(sk)->icsk_pmtu_cookie is last pmtu, seen by this function.
2067 
2068    tp->mss_cache is current effective sending mss, including
2069    all tcp options except for SACKs. It is evaluated,
2070    taking into account current pmtu, but never exceeds
2071    tp->rx_opt.mss_clamp.
2072 
2073    NOTE1. rfc1122 clearly states that advertised MSS
2074    DOES NOT include either tcp or ip options.
2075 
2076    NOTE2. inet_csk(sk)->icsk_pmtu_cookie and tp->mss_cache
2077    are READ ONLY outside this function.		--ANK (980731)
2078  */
2079 unsigned int tcp_sync_mss(struct sock *sk, u32 pmtu)
2080 {
2081 	struct tcp_sock *tp = tcp_sk(sk);
2082 	struct inet_connection_sock *icsk = inet_csk(sk);
2083 	int mss_now;
2084 
2085 	if (icsk->icsk_mtup.search_high > pmtu)
2086 		icsk->icsk_mtup.search_high = pmtu;
2087 
2088 	mss_now = tcp_mtu_to_mss(sk, pmtu);
2089 	mss_now = tcp_bound_to_half_wnd(tp, mss_now);
2090 
2091 	/* And store cached results */
2092 	icsk->icsk_pmtu_cookie = pmtu;
2093 	if (icsk->icsk_mtup.enabled)
2094 		mss_now = min(mss_now, tcp_mtu_to_mss(sk, icsk->icsk_mtup.search_low));
2095 	tp->mss_cache = mss_now;
2096 
2097 	return mss_now;
2098 }
2099 
2100 /* Compute the current effective MSS, taking SACKs and IP options,
2101  * and even PMTU discovery events into account.
2102  */
2103 unsigned int tcp_current_mss(struct sock *sk)
2104 {
2105 	const struct tcp_sock *tp = tcp_sk(sk);
2106 	const struct dst_entry *dst = __sk_dst_get(sk);
2107 	u32 mss_now;
2108 	unsigned int header_len;
2109 	struct tcp_out_options opts;
2110 	struct tcp_key key;
2111 
2112 	mss_now = tp->mss_cache;
2113 
2114 	if (dst) {
2115 		u32 mtu = dst_mtu(dst);
2116 		if (mtu != inet_csk(sk)->icsk_pmtu_cookie)
2117 			mss_now = tcp_sync_mss(sk, mtu);
2118 	}
2119 	tcp_get_current_key(sk, &key);
2120 	header_len = tcp_established_options(sk, NULL, &opts, &key) +
2121 		     sizeof(struct tcphdr);
2122 	/* The mss_cache is sized based on tp->tcp_header_len, which assumes
2123 	 * some common options. If this is an odd packet (because we have SACK
2124 	 * blocks etc) then our calculated header_len will be different, and
2125 	 * we have to adjust mss_now correspondingly */
2126 	if (header_len != tp->tcp_header_len) {
2127 		int delta = (int) header_len - tp->tcp_header_len;
2128 		mss_now -= delta;
2129 	}
2130 
2131 	return mss_now;
2132 }
2133 
2134 /* RFC2861, slow part. Adjust cwnd, after it was not full during one rto.
2135  * As additional protections, we do not touch cwnd in retransmission phases,
2136  * and if application hit its sndbuf limit recently.
2137  */
2138 static void tcp_cwnd_application_limited(struct sock *sk)
2139 {
2140 	struct tcp_sock *tp = tcp_sk(sk);
2141 
2142 	if (inet_csk(sk)->icsk_ca_state == TCP_CA_Open &&
2143 	    sk->sk_socket && !test_bit(SOCK_NOSPACE, &sk->sk_socket->flags)) {
2144 		/* Limited by application or receiver window. */
2145 		u32 init_win = tcp_init_cwnd(tp, __sk_dst_get(sk));
2146 		u32 win_used = max(tp->snd_cwnd_used, init_win);
2147 		if (win_used < tcp_snd_cwnd(tp)) {
2148 			WRITE_ONCE(tp->snd_ssthresh, tcp_current_ssthresh(sk));
2149 			tcp_snd_cwnd_set(tp, (tcp_snd_cwnd(tp) + win_used) >> 1);
2150 		}
2151 		tp->snd_cwnd_used = 0;
2152 	}
2153 	tp->snd_cwnd_stamp = tcp_jiffies32;
2154 }
2155 
2156 static void tcp_cwnd_validate(struct sock *sk, bool is_cwnd_limited)
2157 {
2158 	const struct tcp_congestion_ops *ca_ops = inet_csk(sk)->icsk_ca_ops;
2159 	struct tcp_sock *tp = tcp_sk(sk);
2160 
2161 	/* Track the strongest available signal of the degree to which the cwnd
2162 	 * is fully utilized. If cwnd-limited then remember that fact for the
2163 	 * current window. If not cwnd-limited then track the maximum number of
2164 	 * outstanding packets in the current window. (If cwnd-limited then we
2165 	 * chose to not update tp->max_packets_out to avoid an extra else
2166 	 * clause with no functional impact.)
2167 	 */
2168 	if (!before(tp->snd_una, tp->cwnd_usage_seq) ||
2169 	    is_cwnd_limited ||
2170 	    (!tp->is_cwnd_limited &&
2171 	     tp->packets_out > tp->max_packets_out)) {
2172 		tp->is_cwnd_limited = is_cwnd_limited;
2173 		tp->max_packets_out = tp->packets_out;
2174 		tp->cwnd_usage_seq = tp->snd_nxt;
2175 	}
2176 
2177 	if (tcp_is_cwnd_limited(sk)) {
2178 		/* Network is feed fully. */
2179 		tp->snd_cwnd_used = 0;
2180 		tp->snd_cwnd_stamp = tcp_jiffies32;
2181 	} else {
2182 		/* Network starves. */
2183 		if (tp->packets_out > tp->snd_cwnd_used)
2184 			tp->snd_cwnd_used = tp->packets_out;
2185 
2186 		if (READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_slow_start_after_idle) &&
2187 		    (s32)(tcp_jiffies32 - tp->snd_cwnd_stamp) >= inet_csk(sk)->icsk_rto &&
2188 		    !ca_ops->cong_control)
2189 			tcp_cwnd_application_limited(sk);
2190 
2191 		/* The following conditions together indicate the starvation
2192 		 * is caused by insufficient sender buffer:
2193 		 * 1) just sent some data (see tcp_write_xmit)
2194 		 * 2) not cwnd limited (this else condition)
2195 		 * 3) no more data to send (tcp_write_queue_empty())
2196 		 * 4) application is hitting buffer limit (SOCK_NOSPACE)
2197 		 */
2198 		if (tcp_write_queue_empty(sk) && sk->sk_socket &&
2199 		    test_bit(SOCK_NOSPACE, &sk->sk_socket->flags) &&
2200 		    (1 << sk->sk_state) & (TCPF_ESTABLISHED | TCPF_CLOSE_WAIT))
2201 			tcp_chrono_start(sk, TCP_CHRONO_SNDBUF_LIMITED);
2202 	}
2203 }
2204 
2205 /* Minshall's variant of the Nagle send check. */
2206 static bool tcp_minshall_check(const struct tcp_sock *tp)
2207 {
2208 	return after(tp->snd_sml, tp->snd_una) &&
2209 		!after(tp->snd_sml, tp->snd_nxt);
2210 }
2211 
2212 /* Update snd_sml if this skb is under mss
2213  * Note that a TSO packet might end with a sub-mss segment
2214  * The test is really :
2215  * if ((skb->len % mss) != 0)
2216  *        tp->snd_sml = TCP_SKB_CB(skb)->end_seq;
2217  * But we can avoid doing the divide again given we already have
2218  *  skb_pcount = skb->len / mss_now
2219  */
2220 static void tcp_minshall_update(struct tcp_sock *tp, unsigned int mss_now,
2221 				const struct sk_buff *skb)
2222 {
2223 	if (skb->len < tcp_skb_pcount(skb) * mss_now)
2224 		tp->snd_sml = TCP_SKB_CB(skb)->end_seq;
2225 }
2226 
2227 /* Return false, if packet can be sent now without violation Nagle's rules:
2228  * 1. It is full sized. (provided by caller in %partial bool)
2229  * 2. Or it contains FIN. (already checked by caller)
2230  * 3. Or TCP_CORK is not set, and TCP_NODELAY is set.
2231  * 4. Or TCP_CORK is not set, and all sent packets are ACKed.
2232  *    With Minshall's modification: all sent small packets are ACKed.
2233  */
2234 static bool tcp_nagle_check(bool partial, const struct tcp_sock *tp,
2235 			    int nonagle)
2236 {
2237 	return partial &&
2238 		((nonagle & TCP_NAGLE_CORK) ||
2239 		 (!nonagle && tp->packets_out && tcp_minshall_check(tp)));
2240 }
2241 
2242 /* Return how many segs we'd like on a TSO packet,
2243  * depending on current pacing rate, and how close the peer is.
2244  *
2245  * Rationale is:
2246  * - For close peers, we rather send bigger packets to reduce
2247  *   cpu costs, because occasional losses will be repaired fast.
2248  * - For long distance/rtt flows, we would like to get ACK clocking
2249  *   with 1 ACK per ms.
2250  *
2251  * Use min_rtt to help adapt TSO burst size, with smaller min_rtt resulting
2252  * in bigger TSO bursts. We we cut the RTT-based allowance in half
2253  * for every 2^9 usec (aka 512 us) of RTT, so that the RTT-based allowance
2254  * is below 1500 bytes after 6 * ~500 usec = 3ms.
2255  */
2256 static u32 tcp_tso_autosize(const struct sock *sk, unsigned int mss_now,
2257 			    int min_tso_segs)
2258 {
2259 	unsigned long bytes;
2260 	u32 r;
2261 
2262 	bytes = READ_ONCE(sk->sk_pacing_rate) >> READ_ONCE(sk->sk_pacing_shift);
2263 
2264 	r = tcp_min_rtt(tcp_sk(sk)) >> READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_tso_rtt_log);
2265 	if (r < BITS_PER_TYPE(sk->sk_gso_max_size))
2266 		bytes += sk->sk_gso_max_size >> r;
2267 
2268 	bytes = min_t(unsigned long, bytes, sk->sk_gso_max_size);
2269 
2270 	return max_t(u32, bytes / mss_now, min_tso_segs);
2271 }
2272 
2273 /* Return the number of segments we want in the skb we are transmitting.
2274  * See if congestion control module wants to decide; otherwise, autosize.
2275  */
2276 static u32 tcp_tso_segs(struct sock *sk, unsigned int mss_now)
2277 {
2278 	const struct tcp_congestion_ops *ca_ops = inet_csk(sk)->icsk_ca_ops;
2279 	u32 min_tso, tso_segs;
2280 
2281 	min_tso = ca_ops->min_tso_segs ?
2282 			ca_ops->min_tso_segs(sk) :
2283 			READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_min_tso_segs);
2284 
2285 	tso_segs = tcp_tso_autosize(sk, mss_now, min_tso);
2286 	return min_t(u32, tso_segs, sk->sk_gso_max_segs);
2287 }
2288 
2289 /* Returns the portion of skb which can be sent right away */
2290 static unsigned int tcp_mss_split_point(const struct sock *sk,
2291 					const struct sk_buff *skb,
2292 					unsigned int mss_now,
2293 					unsigned int max_segs,
2294 					int nonagle)
2295 {
2296 	const struct tcp_sock *tp = tcp_sk(sk);
2297 	u32 partial, needed, window, max_len;
2298 
2299 	window = tcp_wnd_end(tp) - TCP_SKB_CB(skb)->seq;
2300 	max_len = mss_now * max_segs;
2301 
2302 	if (likely(max_len <= window && skb != tcp_write_queue_tail(sk)))
2303 		return max_len;
2304 
2305 	needed = min(skb->len, window);
2306 
2307 	if (max_len <= needed)
2308 		return max_len;
2309 
2310 	partial = needed % mss_now;
2311 	/* If last segment is not a full MSS, check if Nagle rules allow us
2312 	 * to include this last segment in this skb.
2313 	 * Otherwise, we'll split the skb at last MSS boundary
2314 	 */
2315 	if (tcp_nagle_check(partial != 0, tp, nonagle))
2316 		return needed - partial;
2317 
2318 	return needed;
2319 }
2320 
2321 /* Can at least one segment of SKB be sent right now, according to the
2322  * congestion window rules?  If so, return how many segments are allowed.
2323  */
2324 static u32 tcp_cwnd_test(const struct tcp_sock *tp)
2325 {
2326 	u32 in_flight, cwnd, halfcwnd;
2327 
2328 	in_flight = tcp_packets_in_flight(tp);
2329 	cwnd = tcp_snd_cwnd(tp);
2330 	if (in_flight >= cwnd)
2331 		return 0;
2332 
2333 	/* For better scheduling, ensure we have at least
2334 	 * 2 GSO packets in flight.
2335 	 */
2336 	halfcwnd = max(cwnd >> 1, 1U);
2337 	return min(halfcwnd, cwnd - in_flight);
2338 }
2339 
2340 /* Initialize TSO state of a skb.
2341  * This must be invoked the first time we consider transmitting
2342  * SKB onto the wire.
2343  */
2344 static int tcp_init_tso_segs(struct sk_buff *skb, unsigned int mss_now)
2345 {
2346 	int tso_segs = tcp_skb_pcount(skb);
2347 
2348 	if (!tso_segs || (tso_segs > 1 && tcp_skb_mss(skb) != mss_now))
2349 		return tcp_set_skb_tso_segs(skb, mss_now);
2350 
2351 	return tso_segs;
2352 }
2353 
2354 
2355 /* Return true if the Nagle test allows this packet to be
2356  * sent now.
2357  */
2358 static inline bool tcp_nagle_test(const struct tcp_sock *tp, const struct sk_buff *skb,
2359 				  unsigned int cur_mss, int nonagle)
2360 {
2361 	/* Nagle rule does not apply to frames, which sit in the middle of the
2362 	 * write_queue (they have no chances to get new data).
2363 	 *
2364 	 * This is implemented in the callers, where they modify the 'nonagle'
2365 	 * argument based upon the location of SKB in the send queue.
2366 	 */
2367 	if (nonagle & TCP_NAGLE_PUSH)
2368 		return true;
2369 
2370 	/* Don't use the nagle rule for urgent data (or for the final FIN). */
2371 	if (tcp_urg_mode(tp) || (TCP_SKB_CB(skb)->tcp_flags & TCPHDR_FIN))
2372 		return true;
2373 
2374 	if (!tcp_nagle_check(skb->len < cur_mss, tp, nonagle))
2375 		return true;
2376 
2377 	return false;
2378 }
2379 
2380 /* Does at least the first segment of SKB fit into the send window? */
2381 static bool tcp_snd_wnd_test(const struct tcp_sock *tp,
2382 			     const struct sk_buff *skb,
2383 			     unsigned int cur_mss)
2384 {
2385 	u32 end_seq = TCP_SKB_CB(skb)->end_seq;
2386 
2387 	if (skb->len > cur_mss)
2388 		end_seq = TCP_SKB_CB(skb)->seq + cur_mss;
2389 
2390 	return !after(end_seq, tcp_wnd_end(tp));
2391 }
2392 
2393 /* Trim TSO SKB to LEN bytes, put the remaining data into a new packet
2394  * which is put after SKB on the list.  It is very much like
2395  * tcp_fragment() except that it may make several kinds of assumptions
2396  * in order to speed up the splitting operation.  In particular, we
2397  * know that all the data is in scatter-gather pages, and that the
2398  * packet has never been sent out before (and thus is not cloned).
2399  */
2400 static int tso_fragment(struct sock *sk, struct sk_buff *skb, unsigned int len,
2401 			unsigned int mss_now, gfp_t gfp)
2402 {
2403 	int nlen = skb->len - len;
2404 	struct sk_buff *buff;
2405 	u16 flags;
2406 
2407 	/* All of a TSO frame must be composed of paged data.  */
2408 	DEBUG_NET_WARN_ON_ONCE(skb->len != skb->data_len);
2409 
2410 	buff = tcp_stream_alloc_skb(sk, gfp, true);
2411 	if (unlikely(!buff))
2412 		return -ENOMEM;
2413 	skb_copy_decrypted(buff, skb);
2414 	mptcp_skb_ext_copy(buff, skb);
2415 
2416 	sk_wmem_queued_add(sk, buff->truesize);
2417 	sk_mem_charge(sk, buff->truesize);
2418 	buff->truesize += nlen;
2419 	skb->truesize -= nlen;
2420 
2421 	/* Correct the sequence numbers. */
2422 	TCP_SKB_CB(buff)->seq = TCP_SKB_CB(skb)->seq + len;
2423 	TCP_SKB_CB(buff)->end_seq = TCP_SKB_CB(skb)->end_seq;
2424 	TCP_SKB_CB(skb)->end_seq = TCP_SKB_CB(buff)->seq;
2425 
2426 	/* PSH and FIN should only be set in the second packet. */
2427 	flags = TCP_SKB_CB(skb)->tcp_flags;
2428 	TCP_SKB_CB(skb)->tcp_flags = flags & ~(TCPHDR_FIN | TCPHDR_PSH);
2429 	TCP_SKB_CB(buff)->tcp_flags = flags;
2430 
2431 	tcp_skb_fragment_eor(skb, buff);
2432 
2433 	skb_split(skb, buff, len);
2434 	tcp_fragment_tstamp(skb, buff);
2435 
2436 	/* Fix up tso_factor for both original and new SKB.  */
2437 	tcp_set_skb_tso_segs(skb, mss_now);
2438 	tcp_set_skb_tso_segs(buff, mss_now);
2439 
2440 	/* Link BUFF into the send queue. */
2441 	__skb_header_release(buff);
2442 	tcp_insert_write_queue_after(skb, buff, sk, TCP_FRAG_IN_WRITE_QUEUE);
2443 
2444 	return 0;
2445 }
2446 
2447 /* Try to defer sending, if possible, in order to minimize the amount
2448  * of TSO splitting we do.  View it as a kind of TSO Nagle test.
2449  *
2450  * This algorithm is from John Heffner.
2451  */
2452 static bool tcp_tso_should_defer(struct sock *sk, struct sk_buff *skb,
2453 				 bool *is_cwnd_limited,
2454 				 bool *is_rwnd_limited,
2455 				 u32 max_segs)
2456 {
2457 	const struct inet_connection_sock *icsk = inet_csk(sk);
2458 	u32 send_win, cong_win, limit, in_flight, threshold;
2459 	u64 srtt_in_ns, expected_ack, how_far_is_the_ack;
2460 	struct tcp_sock *tp = tcp_sk(sk);
2461 	struct sk_buff *head;
2462 	int win_divisor;
2463 	s64 delta;
2464 
2465 	if (icsk->icsk_ca_state >= TCP_CA_Recovery)
2466 		goto send_now;
2467 
2468 	/* Avoid bursty behavior by allowing defer
2469 	 * only if the last write was recent (1 ms).
2470 	 * Note that tp->tcp_wstamp_ns can be in the future if we have
2471 	 * packets waiting in a qdisc or device for EDT delivery.
2472 	 */
2473 	delta = tp->tcp_clock_cache - tp->tcp_wstamp_ns - NSEC_PER_MSEC;
2474 	if (delta > 0)
2475 		goto send_now;
2476 
2477 	in_flight = tcp_packets_in_flight(tp);
2478 
2479 	BUG_ON(tcp_skb_pcount(skb) <= 1);
2480 	BUG_ON(tcp_snd_cwnd(tp) <= in_flight);
2481 
2482 	send_win = tcp_wnd_end(tp) - TCP_SKB_CB(skb)->seq;
2483 
2484 	/* From in_flight test above, we know that cwnd > in_flight.  */
2485 	cong_win = (tcp_snd_cwnd(tp) - in_flight) * tp->mss_cache;
2486 
2487 	limit = min(send_win, cong_win);
2488 
2489 	/* If a full-sized TSO skb can be sent, do it. */
2490 	if (limit >= max_segs * tp->mss_cache)
2491 		goto send_now;
2492 
2493 	/* Middle in queue won't get any more data, full sendable already? */
2494 	if ((skb != tcp_write_queue_tail(sk)) && (limit >= skb->len))
2495 		goto send_now;
2496 
2497 	win_divisor = READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_tso_win_divisor);
2498 	if (win_divisor) {
2499 		u32 chunk = min(tp->snd_wnd, tcp_snd_cwnd(tp) * tp->mss_cache);
2500 
2501 		/* If at least some fraction of a window is available,
2502 		 * just use it.
2503 		 */
2504 		chunk /= win_divisor;
2505 		if (limit >= chunk)
2506 			goto send_now;
2507 	} else {
2508 		/* Different approach, try not to defer past a single
2509 		 * ACK.  Receiver should ACK every other full sized
2510 		 * frame, so if we have space for more than 3 frames
2511 		 * then send now.
2512 		 */
2513 		if (limit > tcp_max_tso_deferred_mss(tp) * tp->mss_cache)
2514 			goto send_now;
2515 	}
2516 
2517 	/* TODO : use tsorted_sent_queue ? */
2518 	head = tcp_rtx_queue_head(sk);
2519 	if (!head)
2520 		goto send_now;
2521 
2522 	srtt_in_ns = (u64)(NSEC_PER_USEC >> 3) * tp->srtt_us;
2523 	/* When is the ACK expected ? */
2524 	expected_ack = head->tstamp + srtt_in_ns;
2525 	/* How far from now is the ACK expected ? */
2526 	how_far_is_the_ack = expected_ack - tp->tcp_clock_cache;
2527 
2528 	/* If next ACK is likely to come too late,
2529 	 * ie in more than min(1ms, half srtt), do not defer.
2530 	 */
2531 	threshold = min(srtt_in_ns >> 1, NSEC_PER_MSEC);
2532 
2533 	if ((s64)(how_far_is_the_ack - threshold) > 0)
2534 		goto send_now;
2535 
2536 	/* Ok, it looks like it is advisable to defer.
2537 	 * Three cases are tracked :
2538 	 * 1) We are cwnd-limited
2539 	 * 2) We are rwnd-limited
2540 	 * 3) We are application limited.
2541 	 */
2542 	if (cong_win < send_win) {
2543 		if (cong_win <= skb->len) {
2544 			*is_cwnd_limited = true;
2545 			return true;
2546 		}
2547 	} else {
2548 		if (send_win <= skb->len) {
2549 			*is_rwnd_limited = true;
2550 			return true;
2551 		}
2552 	}
2553 
2554 	/* If this packet won't get more data, do not wait. */
2555 	if ((TCP_SKB_CB(skb)->tcp_flags & TCPHDR_FIN) ||
2556 	    TCP_SKB_CB(skb)->eor)
2557 		goto send_now;
2558 
2559 	return true;
2560 
2561 send_now:
2562 	return false;
2563 }
2564 
2565 static inline void tcp_mtu_check_reprobe(struct sock *sk)
2566 {
2567 	struct inet_connection_sock *icsk = inet_csk(sk);
2568 	struct tcp_sock *tp = tcp_sk(sk);
2569 	struct net *net = sock_net(sk);
2570 	u32 interval;
2571 	s32 delta;
2572 
2573 	interval = READ_ONCE(net->ipv4.sysctl_tcp_probe_interval);
2574 	delta = tcp_jiffies32 - icsk->icsk_mtup.probe_timestamp;
2575 	if (unlikely(delta >= interval * HZ)) {
2576 		int mss = tcp_current_mss(sk);
2577 
2578 		/* Update current search range */
2579 		icsk->icsk_mtup.probe_size = 0;
2580 		icsk->icsk_mtup.search_high = tp->rx_opt.mss_clamp +
2581 			sizeof(struct tcphdr) +
2582 			icsk->icsk_af_ops->net_header_len;
2583 		icsk->icsk_mtup.search_low = tcp_mss_to_mtu(sk, mss);
2584 
2585 		/* Update probe time stamp */
2586 		icsk->icsk_mtup.probe_timestamp = tcp_jiffies32;
2587 	}
2588 }
2589 
2590 static bool tcp_can_coalesce_send_queue_head(struct sock *sk, int len)
2591 {
2592 	struct sk_buff *skb, *next;
2593 
2594 	skb = tcp_send_head(sk);
2595 	tcp_for_write_queue_from_safe(skb, next, sk) {
2596 		if (len <= skb->len)
2597 			break;
2598 
2599 		if (tcp_has_tx_tstamp(skb) || !tcp_skb_can_collapse(skb, next))
2600 			return false;
2601 
2602 		len -= skb->len;
2603 	}
2604 
2605 	return true;
2606 }
2607 
2608 static int tcp_clone_payload(struct sock *sk, struct sk_buff *to,
2609 			     int probe_size)
2610 {
2611 	skb_frag_t *lastfrag = NULL, *fragto = skb_shinfo(to)->frags;
2612 	int i, todo, len = 0, nr_frags = 0;
2613 	const struct sk_buff *skb;
2614 
2615 	if (!sk_wmem_schedule(sk, to->truesize + probe_size))
2616 		return -ENOMEM;
2617 
2618 	skb_queue_walk(&sk->sk_write_queue, skb) {
2619 		const skb_frag_t *fragfrom = skb_shinfo(skb)->frags;
2620 
2621 		if (skb_headlen(skb))
2622 			return -EINVAL;
2623 
2624 		for (i = 0; i < skb_shinfo(skb)->nr_frags; i++, fragfrom++) {
2625 			if (len >= probe_size)
2626 				goto commit;
2627 			todo = min_t(int, skb_frag_size(fragfrom),
2628 				     probe_size - len);
2629 			len += todo;
2630 			skb_shinfo(to)->flags |= skb_shinfo(skb)->flags & SKBFL_SHARED_FRAG;
2631 			if (lastfrag &&
2632 			    skb_frag_page(fragfrom) == skb_frag_page(lastfrag) &&
2633 			    skb_frag_off(fragfrom) == skb_frag_off(lastfrag) +
2634 						      skb_frag_size(lastfrag)) {
2635 				skb_frag_size_add(lastfrag, todo);
2636 				continue;
2637 			}
2638 			if (unlikely(nr_frags == MAX_SKB_FRAGS))
2639 				return -E2BIG;
2640 			skb_frag_page_copy(fragto, fragfrom);
2641 			skb_frag_off_copy(fragto, fragfrom);
2642 			skb_frag_size_set(fragto, todo);
2643 			nr_frags++;
2644 			lastfrag = fragto++;
2645 		}
2646 	}
2647 commit:
2648 	WARN_ON_ONCE(len != probe_size);
2649 	for (i = 0; i < nr_frags; i++)
2650 		skb_frag_ref(to, i);
2651 
2652 	skb_shinfo(to)->nr_frags = nr_frags;
2653 	to->truesize += probe_size;
2654 	to->len += probe_size;
2655 	to->data_len += probe_size;
2656 	__skb_header_release(to);
2657 	return 0;
2658 }
2659 
2660 /* tcp_mtu_probe() and tcp_grow_skb() can both eat an skb (src) if
2661  * all its payload was moved to another one (dst).
2662  * Make sure to transfer tcp_flags, eor, and tstamp.
2663  */
2664 static void tcp_eat_one_skb(struct sock *sk,
2665 			    struct sk_buff *dst,
2666 			    struct sk_buff *src)
2667 {
2668 	TCP_SKB_CB(dst)->tcp_flags |= TCP_SKB_CB(src)->tcp_flags;
2669 	TCP_SKB_CB(dst)->eor = TCP_SKB_CB(src)->eor;
2670 	tcp_skb_collapse_tstamp(dst, src);
2671 	tcp_unlink_write_queue(src, sk);
2672 	tcp_wmem_free_skb(sk, src);
2673 }
2674 
2675 /* Create a new MTU probe if we are ready.
2676  * MTU probe is regularly attempting to increase the path MTU by
2677  * deliberately sending larger packets.  This discovers routing
2678  * changes resulting in larger path MTUs.
2679  *
2680  * Returns 0 if we should wait to probe (no cwnd available),
2681  *         1 if a probe was sent,
2682  *         -1 otherwise
2683  */
2684 static int tcp_mtu_probe(struct sock *sk)
2685 {
2686 	struct inet_connection_sock *icsk = inet_csk(sk);
2687 	struct tcp_sock *tp = tcp_sk(sk);
2688 	struct sk_buff *skb, *nskb, *next;
2689 	struct net *net = sock_net(sk);
2690 	int probe_size;
2691 	int size_needed;
2692 	int copy, len;
2693 	int mss_now;
2694 	int interval;
2695 
2696 	/* Not currently probing/verifying,
2697 	 * not in recovery,
2698 	 * have enough cwnd, and
2699 	 * not SACKing (the variable headers throw things off)
2700 	 */
2701 	if (likely(!icsk->icsk_mtup.enabled ||
2702 		   icsk->icsk_mtup.probe_size ||
2703 		   inet_csk(sk)->icsk_ca_state != TCP_CA_Open ||
2704 		   tcp_snd_cwnd(tp) < 11 ||
2705 		   tp->rx_opt.num_sacks || tp->rx_opt.dsack))
2706 		return -1;
2707 
2708 	/* Use binary search for probe_size between tcp_mss_base,
2709 	 * and current mss_clamp. if (search_high - search_low)
2710 	 * smaller than a threshold, backoff from probing.
2711 	 */
2712 	mss_now = tcp_current_mss(sk);
2713 	probe_size = tcp_mtu_to_mss(sk, (icsk->icsk_mtup.search_high +
2714 				    icsk->icsk_mtup.search_low) >> 1);
2715 	size_needed = probe_size + (tp->reordering + 1) * tp->mss_cache;
2716 	interval = icsk->icsk_mtup.search_high - icsk->icsk_mtup.search_low;
2717 	/* When misfortune happens, we are reprobing actively,
2718 	 * and then reprobe timer has expired. We stick with current
2719 	 * probing process by not resetting search range to its orignal.
2720 	 */
2721 	if (probe_size > tcp_mtu_to_mss(sk, icsk->icsk_mtup.search_high) ||
2722 	    interval < READ_ONCE(net->ipv4.sysctl_tcp_probe_threshold)) {
2723 		/* Check whether enough time has elaplased for
2724 		 * another round of probing.
2725 		 */
2726 		tcp_mtu_check_reprobe(sk);
2727 		return -1;
2728 	}
2729 
2730 	/* Have enough data in the send queue to probe? */
2731 	if (tp->write_seq - tp->snd_nxt < size_needed)
2732 		return -1;
2733 
2734 	if (tp->snd_wnd < size_needed)
2735 		return -1;
2736 	if (after(tp->snd_nxt + size_needed, tcp_wnd_end(tp)))
2737 		return 0;
2738 
2739 	/* Do we need to wait to drain cwnd? With none in flight, don't stall */
2740 	if (tcp_packets_in_flight(tp) + 2 > tcp_snd_cwnd(tp)) {
2741 		if (!tcp_packets_in_flight(tp))
2742 			return -1;
2743 		else
2744 			return 0;
2745 	}
2746 
2747 	if (!tcp_can_coalesce_send_queue_head(sk, probe_size))
2748 		return -1;
2749 
2750 	/* We're allowed to probe.  Build it now. */
2751 	nskb = tcp_stream_alloc_skb(sk, GFP_ATOMIC, false);
2752 	if (!nskb)
2753 		return -1;
2754 
2755 	/* build the payload, and be prepared to abort if this fails. */
2756 	if (tcp_clone_payload(sk, nskb, probe_size)) {
2757 		tcp_skb_tsorted_anchor_cleanup(nskb);
2758 		consume_skb(nskb);
2759 		return -1;
2760 	}
2761 	sk_wmem_queued_add(sk, nskb->truesize);
2762 	sk_mem_charge(sk, nskb->truesize);
2763 
2764 	skb = tcp_send_head(sk);
2765 	skb_copy_decrypted(nskb, skb);
2766 	mptcp_skb_ext_copy(nskb, skb);
2767 
2768 	TCP_SKB_CB(nskb)->seq = TCP_SKB_CB(skb)->seq;
2769 	TCP_SKB_CB(nskb)->end_seq = TCP_SKB_CB(skb)->seq + probe_size;
2770 	TCP_SKB_CB(nskb)->tcp_flags = TCPHDR_ACK;
2771 
2772 	tcp_insert_write_queue_before(nskb, skb, sk);
2773 	tcp_highest_sack_replace(sk, skb, nskb);
2774 
2775 	len = 0;
2776 	tcp_for_write_queue_from_safe(skb, next, sk) {
2777 		copy = min_t(int, skb->len, probe_size - len);
2778 
2779 		if (skb->len <= copy) {
2780 			tcp_eat_one_skb(sk, nskb, skb);
2781 		} else {
2782 			TCP_SKB_CB(nskb)->tcp_flags |= TCP_SKB_CB(skb)->tcp_flags &
2783 						   ~(TCPHDR_FIN|TCPHDR_PSH);
2784 			__pskb_trim_head(skb, copy);
2785 			tcp_set_skb_tso_segs(skb, mss_now);
2786 			TCP_SKB_CB(skb)->seq += copy;
2787 		}
2788 
2789 		len += copy;
2790 
2791 		if (len >= probe_size)
2792 			break;
2793 	}
2794 	tcp_init_tso_segs(nskb, nskb->len);
2795 
2796 	/* We're ready to send.  If this fails, the probe will
2797 	 * be resegmented into mss-sized pieces by tcp_write_xmit().
2798 	 */
2799 	if (!tcp_transmit_skb(sk, nskb, 1, GFP_ATOMIC)) {
2800 		/* Decrement cwnd here because we are sending
2801 		 * effectively two packets. */
2802 		tcp_snd_cwnd_set(tp, tcp_snd_cwnd(tp) - 1);
2803 		tcp_event_new_data_sent(sk, nskb);
2804 
2805 		icsk->icsk_mtup.probe_size = tcp_mss_to_mtu(sk, nskb->len);
2806 		tp->mtu_probe.probe_seq_start = TCP_SKB_CB(nskb)->seq;
2807 		tp->mtu_probe.probe_seq_end = TCP_SKB_CB(nskb)->end_seq;
2808 
2809 		return 1;
2810 	}
2811 
2812 	return -1;
2813 }
2814 
2815 static bool tcp_pacing_check(struct sock *sk)
2816 {
2817 	struct tcp_sock *tp = tcp_sk(sk);
2818 
2819 	if (!tcp_needs_internal_pacing(sk))
2820 		return false;
2821 
2822 	if (tp->tcp_wstamp_ns <= tp->tcp_clock_cache)
2823 		return false;
2824 
2825 	if (!hrtimer_is_queued(&tp->pacing_timer)) {
2826 		hrtimer_start(&tp->pacing_timer,
2827 			      ns_to_ktime(tp->tcp_wstamp_ns),
2828 			      HRTIMER_MODE_ABS_PINNED_SOFT);
2829 		sock_hold(sk);
2830 	}
2831 	return true;
2832 }
2833 
2834 static bool tcp_rtx_queue_empty_or_single_skb(const struct sock *sk)
2835 {
2836 	const struct rb_node *node = sk->tcp_rtx_queue.rb_node;
2837 
2838 	/* No skb in the rtx queue. */
2839 	if (!node)
2840 		return true;
2841 
2842 	/* Only one skb in rtx queue. */
2843 	return !node->rb_left && !node->rb_right;
2844 }
2845 
2846 /* TCP Small Queues :
2847  * Control number of packets in qdisc/devices to two packets / or ~1 ms.
2848  * (These limits are doubled for retransmits)
2849  * This allows for :
2850  *  - better RTT estimation and ACK scheduling
2851  *  - faster recovery
2852  *  - high rates
2853  * Alas, some drivers / subsystems require a fair amount
2854  * of queued bytes to ensure line rate.
2855  * One example is wifi aggregation (802.11 AMPDU)
2856  */
2857 static bool tcp_small_queue_check(struct sock *sk, const struct sk_buff *skb,
2858 				  unsigned int factor)
2859 {
2860 	unsigned long limit;
2861 
2862 	limit = max_t(unsigned long,
2863 		      2 * skb->truesize,
2864 		      READ_ONCE(sk->sk_pacing_rate) >> READ_ONCE(sk->sk_pacing_shift));
2865 	limit = min_t(unsigned long, limit,
2866 		      READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_limit_output_bytes));
2867 	limit <<= factor;
2868 
2869 	if (static_branch_unlikely(&tcp_tx_delay_enabled) &&
2870 	    tcp_sk(sk)->tcp_tx_delay) {
2871 		u64 extra_bytes = (u64)READ_ONCE(sk->sk_pacing_rate) *
2872 				  tcp_sk(sk)->tcp_tx_delay;
2873 
2874 		/* TSQ is based on skb truesize sum (sk_wmem_alloc), so we
2875 		 * approximate our needs assuming an ~100% skb->truesize overhead.
2876 		 * USEC_PER_SEC is approximated by 2^20.
2877 		 * do_div(extra_bytes, USEC_PER_SEC/2) is replaced by a right shift.
2878 		 */
2879 		extra_bytes >>= (20 - 1);
2880 		limit += extra_bytes;
2881 	}
2882 	if (refcount_read(&sk->sk_wmem_alloc) > limit) {
2883 		/* Always send skb if rtx queue is empty or has one skb.
2884 		 * No need to wait for TX completion to call us back,
2885 		 * after softirq schedule.
2886 		 * This helps when TX completions are delayed too much.
2887 		 */
2888 		if (tcp_rtx_queue_empty_or_single_skb(sk))
2889 			return false;
2890 
2891 		set_bit(TSQ_THROTTLED, &sk->sk_tsq_flags);
2892 		/* It is possible TX completion already happened
2893 		 * before we set TSQ_THROTTLED, so we must
2894 		 * test again the condition.
2895 		 */
2896 		smp_mb__after_atomic();
2897 		if (refcount_read(&sk->sk_wmem_alloc) > limit)
2898 			return true;
2899 	}
2900 	return false;
2901 }
2902 
2903 void tcp_chrono_stop(struct sock *sk, const enum tcp_chrono type)
2904 {
2905 	struct tcp_sock *tp = tcp_sk(sk);
2906 
2907 
2908 	/* There are multiple conditions worthy of tracking in a
2909 	 * chronograph, so that the highest priority enum takes
2910 	 * precedence over the other conditions (see tcp_chrono_start).
2911 	 * If a condition stops, we only stop chrono tracking if
2912 	 * it's the "most interesting" or current chrono we are
2913 	 * tracking and starts busy chrono if we have pending data.
2914 	 */
2915 	if (tcp_rtx_and_write_queues_empty(sk))
2916 		tcp_chrono_set(tp, TCP_CHRONO_UNSPEC);
2917 	else if (type == tp->chrono_type)
2918 		tcp_chrono_set(tp, TCP_CHRONO_BUSY);
2919 }
2920 
2921 /* First skb in the write queue is smaller than ideal packet size.
2922  * Check if we can move payload from the second skb in the queue.
2923  */
2924 static void tcp_grow_skb(struct sock *sk, struct sk_buff *skb, int amount)
2925 {
2926 	struct sk_buff *next_skb = skb->next;
2927 	unsigned int nlen;
2928 
2929 	if (tcp_skb_is_last(sk, skb))
2930 		return;
2931 
2932 	if (!tcp_skb_can_collapse(skb, next_skb))
2933 		return;
2934 
2935 	nlen = min_t(u32, amount, next_skb->len);
2936 	if (!nlen || !skb_shift(skb, next_skb, nlen))
2937 		return;
2938 
2939 	TCP_SKB_CB(skb)->end_seq += nlen;
2940 	TCP_SKB_CB(next_skb)->seq += nlen;
2941 
2942 	if (!next_skb->len) {
2943 		/* In case FIN is set, we need to update end_seq */
2944 		TCP_SKB_CB(skb)->end_seq = TCP_SKB_CB(next_skb)->end_seq;
2945 
2946 		tcp_eat_one_skb(sk, skb, next_skb);
2947 	}
2948 }
2949 
2950 /* This routine writes packets to the network.  It advances the
2951  * send_head.  This happens as incoming acks open up the remote
2952  * window for us.
2953  *
2954  * LARGESEND note: !tcp_urg_mode is overkill, only frames between
2955  * snd_up-64k-mss .. snd_up cannot be large. However, taking into
2956  * account rare use of URG, this is not a big flaw.
2957  *
2958  * Send at most one packet when push_one > 0. Temporarily ignore
2959  * cwnd limit to force at most one packet out when push_one == 2.
2960 
2961  * Returns true, if no segments are in flight and we have queued segments,
2962  * but cannot send anything now because of SWS or another problem.
2963  */
2964 static bool tcp_write_xmit(struct sock *sk, unsigned int mss_now, int nonagle,
2965 			   int push_one, gfp_t gfp)
2966 {
2967 	struct tcp_sock *tp = tcp_sk(sk);
2968 	struct sk_buff *skb;
2969 	unsigned int tso_segs, sent_pkts;
2970 	u32 cwnd_quota, max_segs;
2971 	int result;
2972 	bool is_cwnd_limited = false, is_rwnd_limited = false;
2973 
2974 	sent_pkts = 0;
2975 
2976 	tcp_mstamp_refresh_inline(tp);
2977 
2978 	/* AccECN option beacon depends on mstamp, it may change mss */
2979 	if (tcp_ecn_mode_accecn(tp) && tcp_accecn_option_beacon_check(sk))
2980 		mss_now = tcp_current_mss(sk);
2981 
2982 	if (!push_one) {
2983 		/* Do MTU probing. */
2984 		result = tcp_mtu_probe(sk);
2985 		if (!result) {
2986 			return false;
2987 		} else if (result > 0) {
2988 			sent_pkts = 1;
2989 		}
2990 	}
2991 
2992 	max_segs = tcp_tso_segs(sk, mss_now);
2993 	while ((skb = tcp_send_head(sk))) {
2994 		unsigned int limit;
2995 		int missing_bytes;
2996 
2997 		if (unlikely(tp->repair) && tp->repair_queue == TCP_SEND_QUEUE) {
2998 			/* "skb_mstamp_ns" is used as a start point for the retransmit timer */
2999 			tp->tcp_wstamp_ns = tp->tcp_clock_cache;
3000 			skb_set_delivery_time(skb, tp->tcp_wstamp_ns, SKB_CLOCK_MONOTONIC);
3001 			list_move_tail(&skb->tcp_tsorted_anchor, &tp->tsorted_sent_queue);
3002 			tcp_init_tso_segs(skb, mss_now);
3003 			goto repair; /* Skip network transmission */
3004 		}
3005 
3006 		if (tcp_pacing_check(sk))
3007 			break;
3008 
3009 		cwnd_quota = tcp_cwnd_test(tp);
3010 		if (!cwnd_quota) {
3011 			if (push_one == 2)
3012 				/* Force out a loss probe pkt. */
3013 				cwnd_quota = 1;
3014 			else
3015 				break;
3016 		}
3017 		cwnd_quota = min(cwnd_quota, max_segs);
3018 		missing_bytes = cwnd_quota * mss_now - skb->len;
3019 		if (missing_bytes > 0)
3020 			tcp_grow_skb(sk, skb, missing_bytes);
3021 
3022 		tso_segs = tcp_set_skb_tso_segs(skb, mss_now);
3023 
3024 		if (unlikely(!tcp_snd_wnd_test(tp, skb, mss_now))) {
3025 			is_rwnd_limited = true;
3026 			break;
3027 		}
3028 
3029 		if (tso_segs == 1) {
3030 			if (unlikely(!tcp_nagle_test(tp, skb, mss_now,
3031 						     (tcp_skb_is_last(sk, skb) ?
3032 						      nonagle : TCP_NAGLE_PUSH))))
3033 				break;
3034 		} else {
3035 			if (!push_one &&
3036 			    tcp_tso_should_defer(sk, skb, &is_cwnd_limited,
3037 						 &is_rwnd_limited, max_segs))
3038 				break;
3039 		}
3040 
3041 		limit = mss_now;
3042 		if (tso_segs > 1 && !tcp_urg_mode(tp))
3043 			limit = tcp_mss_split_point(sk, skb, mss_now,
3044 						    cwnd_quota,
3045 						    nonagle);
3046 
3047 		if (skb->len > limit &&
3048 		    unlikely(tso_fragment(sk, skb, limit, mss_now, gfp)))
3049 			break;
3050 
3051 		if (tcp_small_queue_check(sk, skb, 0))
3052 			break;
3053 
3054 		/* Argh, we hit an empty skb(), presumably a thread
3055 		 * is sleeping in sendmsg()/sk_stream_wait_memory().
3056 		 * We do not want to send a pure-ack packet and have
3057 		 * a strange looking rtx queue with empty packet(s).
3058 		 */
3059 		if (TCP_SKB_CB(skb)->end_seq == TCP_SKB_CB(skb)->seq)
3060 			break;
3061 
3062 		if (unlikely(tcp_transmit_skb(sk, skb, 1, gfp)))
3063 			break;
3064 
3065 repair:
3066 		/* Advance the send_head.  This one is sent out.
3067 		 * This call will increment packets_out.
3068 		 */
3069 		tcp_event_new_data_sent(sk, skb);
3070 
3071 		tcp_minshall_update(tp, mss_now, skb);
3072 		sent_pkts += tcp_skb_pcount(skb);
3073 
3074 		if (push_one)
3075 			break;
3076 	}
3077 
3078 	if (is_rwnd_limited)
3079 		tcp_chrono_start(sk, TCP_CHRONO_RWND_LIMITED);
3080 	else
3081 		tcp_chrono_stop(sk, TCP_CHRONO_RWND_LIMITED);
3082 
3083 	is_cwnd_limited |= (tcp_packets_in_flight(tp) >= tcp_snd_cwnd(tp));
3084 	if (likely(sent_pkts || is_cwnd_limited))
3085 		tcp_cwnd_validate(sk, is_cwnd_limited);
3086 
3087 	if (likely(sent_pkts)) {
3088 		if (tcp_in_cwnd_reduction(sk))
3089 			tp->prr_out += sent_pkts;
3090 
3091 		/* Send one loss probe per tail loss episode. */
3092 		if (push_one != 2)
3093 			tcp_schedule_loss_probe(sk, false);
3094 		return false;
3095 	}
3096 	return !tp->packets_out && !tcp_write_queue_empty(sk);
3097 }
3098 
3099 bool tcp_schedule_loss_probe(struct sock *sk, bool advancing_rto)
3100 {
3101 	struct inet_connection_sock *icsk = inet_csk(sk);
3102 	struct tcp_sock *tp = tcp_sk(sk);
3103 	u32 timeout, timeout_us, rto_delta_us;
3104 	int early_retrans;
3105 
3106 	/* Don't do any loss probe on a Fast Open connection before 3WHS
3107 	 * finishes.
3108 	 */
3109 	if (rcu_access_pointer(tp->fastopen_rsk))
3110 		return false;
3111 
3112 	early_retrans = READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_early_retrans);
3113 	/* Schedule a loss probe in 2*RTT for SACK capable connections
3114 	 * not in loss recovery, that are either limited by cwnd or application.
3115 	 */
3116 	if ((early_retrans != 3 && early_retrans != 4) ||
3117 	    !tcp_is_sack(tp) ||
3118 	    (icsk->icsk_ca_state != TCP_CA_Open &&
3119 	     icsk->icsk_ca_state != TCP_CA_CWR))
3120 		return false;
3121 
3122 	/* Probe timeout is 2*rtt. Add minimum RTO to account
3123 	 * for delayed ack when there's one outstanding packet. If no RTT
3124 	 * sample is available then probe after TCP_TIMEOUT_INIT.
3125 	 */
3126 	if (tp->srtt_us) {
3127 		timeout_us = tp->srtt_us >> 2;
3128 		if (tp->packets_out == 1)
3129 			timeout_us += tcp_rto_min_us(sk);
3130 		else
3131 			timeout_us += TCP_TIMEOUT_MIN_US;
3132 		timeout = usecs_to_jiffies(timeout_us);
3133 	} else {
3134 		timeout = TCP_TIMEOUT_INIT;
3135 	}
3136 
3137 	/* If the RTO formula yields an earlier time, then use that time. */
3138 	rto_delta_us = advancing_rto ?
3139 			jiffies_to_usecs(inet_csk(sk)->icsk_rto) :
3140 			tcp_rto_delta_us(sk);  /* How far in future is RTO? */
3141 	if (rto_delta_us > 0)
3142 		timeout = min_t(u32, timeout, usecs_to_jiffies(rto_delta_us));
3143 
3144 	tcp_reset_xmit_timer(sk, ICSK_TIME_LOSS_PROBE, timeout, true);
3145 	return true;
3146 }
3147 
3148 /* Thanks to skb fast clones, we can detect if a prior transmit of
3149  * a packet is still in a qdisc or driver queue.
3150  * In this case, there is very little point doing a retransmit !
3151  */
3152 static bool skb_still_in_host_queue(struct sock *sk,
3153 				    const struct sk_buff *skb)
3154 {
3155 	if (unlikely(skb_fclone_busy(sk, skb))) {
3156 		set_bit(TSQ_THROTTLED, &sk->sk_tsq_flags);
3157 		smp_mb__after_atomic();
3158 		if (skb_fclone_busy(sk, skb)) {
3159 			NET_INC_STATS(sock_net(sk),
3160 				      LINUX_MIB_TCPSPURIOUS_RTX_HOSTQUEUES);
3161 			return true;
3162 		}
3163 	}
3164 	return false;
3165 }
3166 
3167 /* When probe timeout (PTO) fires, try send a new segment if possible, else
3168  * retransmit the last segment.
3169  */
3170 void tcp_send_loss_probe(struct sock *sk)
3171 {
3172 	struct tcp_sock *tp = tcp_sk(sk);
3173 	struct sk_buff *skb;
3174 	int pcount;
3175 	int mss = tcp_current_mss(sk);
3176 
3177 	/* At most one outstanding TLP */
3178 	if (tp->tlp_high_seq)
3179 		goto rearm_timer;
3180 
3181 	tp->tlp_retrans = 0;
3182 	skb = tcp_send_head(sk);
3183 	if (skb && tcp_snd_wnd_test(tp, skb, mss)) {
3184 		pcount = tp->packets_out;
3185 		tcp_write_xmit(sk, mss, TCP_NAGLE_OFF, 2, GFP_ATOMIC);
3186 		if (tp->packets_out > pcount)
3187 			goto probe_sent;
3188 		goto rearm_timer;
3189 	}
3190 	skb = skb_rb_last(&sk->tcp_rtx_queue);
3191 	if (unlikely(!skb)) {
3192 		tcp_warn_once(sk, tp->packets_out, "invalid inflight: ");
3193 		smp_store_release(&inet_csk(sk)->icsk_pending, 0);
3194 		return;
3195 	}
3196 
3197 	if (skb_still_in_host_queue(sk, skb))
3198 		goto rearm_timer;
3199 
3200 	pcount = tcp_skb_pcount(skb);
3201 	if (WARN_ON(!pcount))
3202 		goto rearm_timer;
3203 
3204 	if ((pcount > 1) && (skb->len > (pcount - 1) * mss)) {
3205 		if (unlikely(tcp_fragment(sk, TCP_FRAG_IN_RTX_QUEUE, skb,
3206 					  (pcount - 1) * mss, mss,
3207 					  GFP_ATOMIC)))
3208 			goto rearm_timer;
3209 		skb = skb_rb_next(skb);
3210 	}
3211 
3212 	if (WARN_ON(!skb || !tcp_skb_pcount(skb)))
3213 		goto rearm_timer;
3214 
3215 	if (__tcp_retransmit_skb(sk, skb, 1))
3216 		goto rearm_timer;
3217 
3218 	tp->tlp_retrans = 1;
3219 
3220 probe_sent:
3221 	/* Record snd_nxt for loss detection. */
3222 	tp->tlp_high_seq = tp->snd_nxt;
3223 
3224 	NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPLOSSPROBES);
3225 	/* Reset s.t. tcp_rearm_rto will restart timer from now */
3226 	smp_store_release(&inet_csk(sk)->icsk_pending, 0);
3227 rearm_timer:
3228 	tcp_rearm_rto(sk);
3229 }
3230 
3231 /* Push out any pending frames which were held back due to
3232  * TCP_CORK or attempt at coalescing tiny packets.
3233  * The socket must be locked by the caller.
3234  */
3235 void __tcp_push_pending_frames(struct sock *sk, unsigned int cur_mss,
3236 			       int nonagle)
3237 {
3238 	/* If we are closed, the bytes will have to remain here.
3239 	 * In time closedown will finish, we empty the write queue and
3240 	 * all will be happy.
3241 	 */
3242 	if (unlikely(sk->sk_state == TCP_CLOSE))
3243 		return;
3244 
3245 	if (tcp_write_xmit(sk, cur_mss, nonagle, 0,
3246 			   sk_gfp_mask(sk, GFP_ATOMIC)))
3247 		tcp_check_probe_timer(sk);
3248 }
3249 
3250 /* Send _single_ skb sitting at the send head. This function requires
3251  * true push pending frames to setup probe timer etc.
3252  */
3253 void tcp_push_one(struct sock *sk, unsigned int mss_now)
3254 {
3255 	struct sk_buff *skb = tcp_send_head(sk);
3256 
3257 	BUG_ON(!skb || skb->len < mss_now);
3258 
3259 	tcp_write_xmit(sk, mss_now, TCP_NAGLE_PUSH, 1, sk->sk_allocation);
3260 }
3261 
3262 /* This function returns the amount that we can raise the
3263  * usable window based on the following constraints
3264  *
3265  * 1. The window can never be shrunk once it is offered (RFC 793)
3266  * 2. We limit memory per socket
3267  *
3268  * RFC 1122:
3269  * "the suggested [SWS] avoidance algorithm for the receiver is to keep
3270  *  RECV.NEXT + RCV.WIN fixed until:
3271  *  RCV.BUFF - RCV.USER - RCV.WINDOW >= min(1/2 RCV.BUFF, MSS)"
3272  *
3273  * i.e. don't raise the right edge of the window until you can raise
3274  * it at least MSS bytes.
3275  *
3276  * Unfortunately, the recommended algorithm breaks header prediction,
3277  * since header prediction assumes th->window stays fixed.
3278  *
3279  * Strictly speaking, keeping th->window fixed violates the receiver
3280  * side SWS prevention criteria. The problem is that under this rule
3281  * a stream of single byte packets will cause the right side of the
3282  * window to always advance by a single byte.
3283  *
3284  * Of course, if the sender implements sender side SWS prevention
3285  * then this will not be a problem.
3286  *
3287  * BSD seems to make the following compromise:
3288  *
3289  *	If the free space is less than the 1/4 of the maximum
3290  *	space available and the free space is less than 1/2 mss,
3291  *	then set the window to 0.
3292  *	[ Actually, bsd uses MSS and 1/4 of maximal _window_ ]
3293  *	Otherwise, just prevent the window from shrinking
3294  *	and from being larger than the largest representable value.
3295  *
3296  * This prevents incremental opening of the window in the regime
3297  * where TCP is limited by the speed of the reader side taking
3298  * data out of the TCP receive queue. It does nothing about
3299  * those cases where the window is constrained on the sender side
3300  * because the pipeline is full.
3301  *
3302  * BSD also seems to "accidentally" limit itself to windows that are a
3303  * multiple of MSS, at least until the free space gets quite small.
3304  * This would appear to be a side effect of the mbuf implementation.
3305  * Combining these two algorithms results in the observed behavior
3306  * of having a fixed window size at almost all times.
3307  *
3308  * Below we obtain similar behavior by forcing the offered window to
3309  * a multiple of the mss when it is feasible to do so.
3310  *
3311  * Note, we don't "adjust" for TIMESTAMP or SACK option bytes.
3312  * Regular options like TIMESTAMP are taken into account.
3313  */
3314 u32 __tcp_select_window(struct sock *sk)
3315 {
3316 	struct inet_connection_sock *icsk = inet_csk(sk);
3317 	struct tcp_sock *tp = tcp_sk(sk);
3318 	struct net *net = sock_net(sk);
3319 	/* MSS for the peer's data.  Previous versions used mss_clamp
3320 	 * here.  I don't know if the value based on our guesses
3321 	 * of peer's MSS is better for the performance.  It's more correct
3322 	 * but may be worse for the performance because of rcv_mss
3323 	 * fluctuations.  --SAW  1998/11/1
3324 	 */
3325 	int mss = icsk->icsk_ack.rcv_mss;
3326 	int free_space = tcp_space(sk);
3327 	int allowed_space = tcp_full_space(sk);
3328 	int full_space, window;
3329 
3330 	if (sk_is_mptcp(sk))
3331 		mptcp_space(sk, &free_space, &allowed_space);
3332 
3333 	full_space = min_t(int, tp->window_clamp, allowed_space);
3334 
3335 	if (unlikely(mss > full_space)) {
3336 		mss = full_space;
3337 		if (mss <= 0)
3338 			return 0;
3339 	}
3340 
3341 	/* Only allow window shrink if the sysctl is enabled and we have
3342 	 * a non-zero scaling factor in effect.
3343 	 */
3344 	if (READ_ONCE(net->ipv4.sysctl_tcp_shrink_window) && tp->rx_opt.rcv_wscale)
3345 		goto shrink_window_allowed;
3346 
3347 	/* do not allow window to shrink */
3348 
3349 	if (free_space < (full_space >> 1)) {
3350 		icsk->icsk_ack.quick = 0;
3351 
3352 		if (tcp_under_memory_pressure(sk))
3353 			tcp_adjust_rcv_ssthresh(sk);
3354 
3355 		/* free_space might become our new window, make sure we don't
3356 		 * increase it due to wscale.
3357 		 */
3358 		free_space = round_down(free_space, 1 << tp->rx_opt.rcv_wscale);
3359 
3360 		/* if free space is less than mss estimate, or is below 1/16th
3361 		 * of the maximum allowed, try to move to zero-window, else
3362 		 * tcp_clamp_window() will grow rcv buf up to tcp_rmem[2], and
3363 		 * new incoming data is dropped due to memory limits.
3364 		 * With large window, mss test triggers way too late in order
3365 		 * to announce zero window in time before rmem limit kicks in.
3366 		 */
3367 		if (free_space < (allowed_space >> 4) || free_space < mss)
3368 			return 0;
3369 	}
3370 
3371 	if (free_space > tp->rcv_ssthresh)
3372 		free_space = tp->rcv_ssthresh;
3373 
3374 	/* Don't do rounding if we are using window scaling, since the
3375 	 * scaled window will not line up with the MSS boundary anyway.
3376 	 */
3377 	if (tp->rx_opt.rcv_wscale) {
3378 		window = free_space;
3379 
3380 		/* Advertise enough space so that it won't get scaled away.
3381 		 * Import case: prevent zero window announcement if
3382 		 * 1<<rcv_wscale > mss.
3383 		 */
3384 		window = ALIGN(window, (1 << tp->rx_opt.rcv_wscale));
3385 	} else {
3386 		window = tp->rcv_wnd;
3387 		/* Get the largest window that is a nice multiple of mss.
3388 		 * Window clamp already applied above.
3389 		 * If our current window offering is within 1 mss of the
3390 		 * free space we just keep it. This prevents the divide
3391 		 * and multiply from happening most of the time.
3392 		 * We also don't do any window rounding when the free space
3393 		 * is too small.
3394 		 */
3395 		if (window <= free_space - mss || window > free_space)
3396 			window = rounddown(free_space, mss);
3397 		else if (mss == full_space &&
3398 			 free_space > window + (full_space >> 1))
3399 			window = free_space;
3400 	}
3401 
3402 	return window;
3403 
3404 shrink_window_allowed:
3405 	/* new window should always be an exact multiple of scaling factor */
3406 	free_space = round_down(free_space, 1 << tp->rx_opt.rcv_wscale);
3407 
3408 	if (free_space < (full_space >> 1)) {
3409 		icsk->icsk_ack.quick = 0;
3410 
3411 		if (tcp_under_memory_pressure(sk))
3412 			tcp_adjust_rcv_ssthresh(sk);
3413 
3414 		/* if free space is too low, return a zero window */
3415 		if (free_space < (allowed_space >> 4) || free_space < mss ||
3416 			free_space < (1 << tp->rx_opt.rcv_wscale))
3417 			return 0;
3418 	}
3419 
3420 	if (free_space > tp->rcv_ssthresh) {
3421 		free_space = tp->rcv_ssthresh;
3422 		/* new window should always be an exact multiple of scaling factor
3423 		 *
3424 		 * For this case, we ALIGN "up" (increase free_space) because
3425 		 * we know free_space is not zero here, it has been reduced from
3426 		 * the memory-based limit, and rcv_ssthresh is not a hard limit
3427 		 * (unlike sk_rcvbuf).
3428 		 */
3429 		free_space = ALIGN(free_space, (1 << tp->rx_opt.rcv_wscale));
3430 	}
3431 
3432 	return free_space;
3433 }
3434 
3435 void tcp_skb_collapse_tstamp(struct sk_buff *skb,
3436 			     const struct sk_buff *next_skb)
3437 {
3438 	if (unlikely(tcp_has_tx_tstamp(next_skb))) {
3439 		const struct skb_shared_info *next_shinfo =
3440 			skb_shinfo(next_skb);
3441 		struct skb_shared_info *shinfo = skb_shinfo(skb);
3442 
3443 		shinfo->tx_flags |= next_shinfo->tx_flags & SKBTX_ANY_TSTAMP;
3444 		shinfo->tskey = next_shinfo->tskey;
3445 		TCP_SKB_CB(skb)->txstamp_ack |=
3446 			TCP_SKB_CB(next_skb)->txstamp_ack;
3447 	}
3448 }
3449 
3450 /* Collapses two adjacent SKB's during retransmission. */
3451 static bool tcp_collapse_retrans(struct sock *sk, struct sk_buff *skb)
3452 {
3453 	struct tcp_sock *tp = tcp_sk(sk);
3454 	struct sk_buff *next_skb = skb_rb_next(skb);
3455 	int next_skb_size;
3456 
3457 	next_skb_size = next_skb->len;
3458 
3459 	BUG_ON(tcp_skb_pcount(skb) != 1 || tcp_skb_pcount(next_skb) != 1);
3460 
3461 	if (next_skb_size && !tcp_skb_shift(skb, next_skb, 1, next_skb_size))
3462 		return false;
3463 
3464 	tcp_highest_sack_replace(sk, next_skb, skb);
3465 
3466 	/* Update sequence range on original skb. */
3467 	TCP_SKB_CB(skb)->end_seq = TCP_SKB_CB(next_skb)->end_seq;
3468 
3469 	/* Merge over control information. This moves PSH/FIN etc. over */
3470 	TCP_SKB_CB(skb)->tcp_flags |= TCP_SKB_CB(next_skb)->tcp_flags;
3471 
3472 	/* All done, get rid of second SKB and account for it so
3473 	 * packet counting does not break.
3474 	 */
3475 	TCP_SKB_CB(skb)->sacked |= TCP_SKB_CB(next_skb)->sacked & TCPCB_EVER_RETRANS;
3476 	TCP_SKB_CB(skb)->eor = TCP_SKB_CB(next_skb)->eor;
3477 
3478 	/* changed transmit queue under us so clear hints */
3479 	if (next_skb == tp->retransmit_skb_hint)
3480 		tp->retransmit_skb_hint = skb;
3481 
3482 	tcp_adjust_pcount(sk, next_skb, tcp_skb_pcount(next_skb));
3483 
3484 	tcp_skb_collapse_tstamp(skb, next_skb);
3485 
3486 	tcp_rtx_queue_unlink_and_free(next_skb, sk);
3487 	return true;
3488 }
3489 
3490 /* Check if coalescing SKBs is legal. */
3491 static bool tcp_can_collapse(const struct sock *sk, const struct sk_buff *skb)
3492 {
3493 	if (tcp_skb_pcount(skb) > 1)
3494 		return false;
3495 	if (skb_cloned(skb))
3496 		return false;
3497 	if (!skb_frags_readable(skb))
3498 		return false;
3499 	/* Some heuristics for collapsing over SACK'd could be invented */
3500 	if (TCP_SKB_CB(skb)->sacked & TCPCB_SACKED_ACKED)
3501 		return false;
3502 
3503 	return true;
3504 }
3505 
3506 /* Collapse packets in the retransmit queue to make to create
3507  * less packets on the wire. This is only done on retransmission.
3508  */
3509 static void tcp_retrans_try_collapse(struct sock *sk, struct sk_buff *to,
3510 				     int space)
3511 {
3512 	struct tcp_sock *tp = tcp_sk(sk);
3513 	struct sk_buff *skb = to, *tmp;
3514 	bool first = true;
3515 
3516 	if (!READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_retrans_collapse))
3517 		return;
3518 	if (TCP_SKB_CB(skb)->tcp_flags & TCPHDR_SYN)
3519 		return;
3520 
3521 	skb_rbtree_walk_from_safe(skb, tmp) {
3522 		if (!tcp_can_collapse(sk, skb))
3523 			break;
3524 
3525 		if (!tcp_skb_can_collapse(to, skb))
3526 			break;
3527 
3528 		space -= skb->len;
3529 
3530 		if (first) {
3531 			first = false;
3532 			continue;
3533 		}
3534 
3535 		if (space < 0)
3536 			break;
3537 
3538 		if (after(TCP_SKB_CB(skb)->end_seq, tcp_wnd_end(tp)))
3539 			break;
3540 
3541 		if (!tcp_collapse_retrans(sk, to))
3542 			break;
3543 	}
3544 }
3545 
3546 /* This retransmits one SKB.  Policy decisions and retransmit queue
3547  * state updates are done by the caller.  Returns non-zero if an
3548  * error occurred which prevented the send.
3549  */
3550 int __tcp_retransmit_skb(struct sock *sk, struct sk_buff *skb, int segs)
3551 {
3552 	struct inet_connection_sock *icsk = inet_csk(sk);
3553 	struct tcp_sock *tp = tcp_sk(sk);
3554 	unsigned int cur_mss;
3555 	int diff, len, err;
3556 	int avail_wnd;
3557 
3558 	/* Inconclusive MTU probe */
3559 	if (icsk->icsk_mtup.probe_size)
3560 		icsk->icsk_mtup.probe_size = 0;
3561 
3562 	if (skb_still_in_host_queue(sk, skb)) {
3563 		err = -EBUSY;
3564 		goto out;
3565 	}
3566 
3567 start:
3568 	if (before(TCP_SKB_CB(skb)->seq, tp->snd_una)) {
3569 		if (unlikely(TCP_SKB_CB(skb)->tcp_flags & TCPHDR_SYN)) {
3570 			TCP_SKB_CB(skb)->tcp_flags &= ~TCPHDR_SYN;
3571 			TCP_SKB_CB(skb)->seq++;
3572 			goto start;
3573 		}
3574 		if (unlikely(before(TCP_SKB_CB(skb)->end_seq, tp->snd_una))) {
3575 			WARN_ON_ONCE(1);
3576 			err = -EINVAL;
3577 			goto out;
3578 		}
3579 		if (tcp_trim_head(sk, skb, tp->snd_una - TCP_SKB_CB(skb)->seq)) {
3580 			err = -ENOMEM;
3581 			goto out;
3582 		}
3583 	}
3584 
3585 	if (inet_csk(sk)->icsk_af_ops->rebuild_header(sk)) {
3586 		err = -EHOSTUNREACH; /* Routing failure or similar. */
3587 		goto out;
3588 	}
3589 
3590 	cur_mss = tcp_current_mss(sk);
3591 	avail_wnd = tcp_wnd_end(tp) - TCP_SKB_CB(skb)->seq;
3592 
3593 	/* If receiver has shrunk his window, and skb is out of
3594 	 * new window, do not retransmit it. The exception is the
3595 	 * case, when window is shrunk to zero. In this case
3596 	 * our retransmit of one segment serves as a zero window probe.
3597 	 */
3598 	if (avail_wnd <= 0) {
3599 		if (TCP_SKB_CB(skb)->seq != tp->snd_una) {
3600 			err = -EAGAIN;
3601 			goto out;
3602 		}
3603 		avail_wnd = cur_mss;
3604 	}
3605 
3606 	len = cur_mss * segs;
3607 	if (len > avail_wnd) {
3608 		len = rounddown(avail_wnd, cur_mss);
3609 		if (!len)
3610 			len = avail_wnd;
3611 	}
3612 	if (skb->len > len) {
3613 		if (tcp_fragment(sk, TCP_FRAG_IN_RTX_QUEUE, skb, len,
3614 				 cur_mss, GFP_ATOMIC)) {
3615 			err = -ENOMEM;  /* We'll try again later. */
3616 			goto out;
3617 		}
3618 	} else {
3619 		if (skb_unclone_keeptruesize(skb, GFP_ATOMIC)) {
3620 			err = -ENOMEM;
3621 			goto out;
3622 		}
3623 
3624 		diff = tcp_skb_pcount(skb);
3625 		tcp_set_skb_tso_segs(skb, cur_mss);
3626 		diff -= tcp_skb_pcount(skb);
3627 		if (diff)
3628 			tcp_adjust_pcount(sk, skb, diff);
3629 		avail_wnd = min_t(int, avail_wnd, cur_mss);
3630 		if (skb->len < avail_wnd)
3631 			tcp_retrans_try_collapse(sk, skb, avail_wnd);
3632 	}
3633 
3634 	if (!tcp_ecn_mode_pending(tp) || icsk->icsk_retransmits > 1) {
3635 		/* RFC3168, section 6.1.1.1. ECN fallback
3636 		 * As AccECN uses the same SYN flags (+ AE), this check
3637 		 * covers both cases.
3638 		 */
3639 		if ((TCP_SKB_CB(skb)->tcp_flags & TCPHDR_SYN_ECN) ==
3640 		    TCPHDR_SYN_ECN)
3641 			tcp_ecn_clear_syn(sk, skb);
3642 	}
3643 
3644 	/* Update global and local TCP statistics. */
3645 	segs = tcp_skb_pcount(skb);
3646 	TCP_ADD_STATS(sock_net(sk), TCP_MIB_RETRANSSEGS, segs);
3647 	if (TCP_SKB_CB(skb)->tcp_flags & TCPHDR_SYN)
3648 		__NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPSYNRETRANS);
3649 	WRITE_ONCE(tp->total_retrans, tp->total_retrans + segs);
3650 	WRITE_ONCE(tp->bytes_retrans, tp->bytes_retrans + skb->len);
3651 
3652 	/* make sure skb->data is aligned on arches that require it
3653 	 * and check if ack-trimming & collapsing extended the headroom
3654 	 * beyond what csum_start can cover.
3655 	 */
3656 	if (unlikely((NET_IP_ALIGN && ((unsigned long)skb->data & 3)) ||
3657 		     skb_headroom(skb) >= 0xFFFF)) {
3658 		struct sk_buff *nskb;
3659 
3660 		tcp_skb_tsorted_save(skb) {
3661 			nskb = __pskb_copy(skb, MAX_TCP_HEADER, GFP_ATOMIC);
3662 			if (nskb) {
3663 				nskb->dev = NULL;
3664 				err = tcp_transmit_skb(sk, nskb, 0, GFP_ATOMIC);
3665 			} else {
3666 				err = -ENOBUFS;
3667 			}
3668 		} tcp_skb_tsorted_restore(skb);
3669 
3670 		if (!err) {
3671 			tcp_update_skb_after_send(sk, skb, tp->tcp_wstamp_ns);
3672 			tcp_rate_skb_sent(sk, skb);
3673 		}
3674 	} else {
3675 		err = tcp_transmit_skb(sk, skb, 1, GFP_ATOMIC);
3676 	}
3677 
3678 	if (BPF_SOCK_OPS_TEST_FLAG(tp, BPF_SOCK_OPS_RETRANS_CB_FLAG))
3679 		tcp_call_bpf_3arg(sk, BPF_SOCK_OPS_RETRANS_CB,
3680 				  TCP_SKB_CB(skb)->seq, segs, err);
3681 
3682 	if (unlikely(err) && err != -EBUSY)
3683 		NET_ADD_STATS(sock_net(sk), LINUX_MIB_TCPRETRANSFAIL, segs);
3684 
3685 	/* To avoid taking spuriously low RTT samples based on a timestamp
3686 	 * for a transmit that never happened, always mark EVER_RETRANS
3687 	 */
3688 	TCP_SKB_CB(skb)->sacked |= TCPCB_EVER_RETRANS;
3689 
3690 out:
3691 	trace_tcp_retransmit_skb(sk, skb, err);
3692 	return err;
3693 }
3694 
3695 int tcp_retransmit_skb(struct sock *sk, struct sk_buff *skb, int segs)
3696 {
3697 	struct tcp_sock *tp = tcp_sk(sk);
3698 	int err = __tcp_retransmit_skb(sk, skb, segs);
3699 
3700 	if (err == 0) {
3701 #if FASTRETRANS_DEBUG > 0
3702 		if (TCP_SKB_CB(skb)->sacked & TCPCB_SACKED_RETRANS) {
3703 			net_dbg_ratelimited("retrans_out leaked\n");
3704 		}
3705 #endif
3706 		TCP_SKB_CB(skb)->sacked |= TCPCB_RETRANS;
3707 		tp->retrans_out += tcp_skb_pcount(skb);
3708 	}
3709 
3710 	/* Save stamp of the first (attempted) retransmit. */
3711 	if (!tp->retrans_stamp)
3712 		tp->retrans_stamp = tcp_skb_timestamp_ts(tp->tcp_usec_ts, skb);
3713 
3714 	if (tp->undo_retrans < 0)
3715 		tp->undo_retrans = 0;
3716 	tp->undo_retrans += tcp_skb_pcount(skb);
3717 	return err;
3718 }
3719 
3720 /* This gets called after a retransmit timeout, and the initially
3721  * retransmitted data is acknowledged.  It tries to continue
3722  * resending the rest of the retransmit queue, until either
3723  * we've sent it all or the congestion window limit is reached.
3724  */
3725 void tcp_xmit_retransmit_queue(struct sock *sk)
3726 {
3727 	const struct inet_connection_sock *icsk = inet_csk(sk);
3728 	struct sk_buff *skb, *rtx_head, *hole = NULL;
3729 	struct tcp_sock *tp = tcp_sk(sk);
3730 	bool rearm_timer = false;
3731 	u32 max_segs;
3732 	int mib_idx;
3733 
3734 	if (!tp->packets_out)
3735 		return;
3736 
3737 	rtx_head = tcp_rtx_queue_head(sk);
3738 	skb = tp->retransmit_skb_hint ?: rtx_head;
3739 	max_segs = tcp_tso_segs(sk, tcp_current_mss(sk));
3740 	skb_rbtree_walk_from(skb) {
3741 		__u8 sacked;
3742 		int segs;
3743 
3744 		if (tcp_pacing_check(sk))
3745 			break;
3746 
3747 		/* we could do better than to assign each time */
3748 		if (!hole)
3749 			tp->retransmit_skb_hint = skb;
3750 
3751 		segs = tcp_snd_cwnd(tp) - tcp_packets_in_flight(tp);
3752 		if (segs <= 0)
3753 			break;
3754 		sacked = TCP_SKB_CB(skb)->sacked;
3755 		/* In case tcp_shift_skb_data() have aggregated large skbs,
3756 		 * we need to make sure not sending too bigs TSO packets
3757 		 */
3758 		segs = min_t(int, segs, max_segs);
3759 
3760 		if (tp->retrans_out >= tp->lost_out) {
3761 			break;
3762 		} else if (!(sacked & TCPCB_LOST)) {
3763 			if (!hole && !(sacked & (TCPCB_SACKED_RETRANS|TCPCB_SACKED_ACKED)))
3764 				hole = skb;
3765 			continue;
3766 
3767 		} else {
3768 			if (icsk->icsk_ca_state != TCP_CA_Loss)
3769 				mib_idx = LINUX_MIB_TCPFASTRETRANS;
3770 			else
3771 				mib_idx = LINUX_MIB_TCPSLOWSTARTRETRANS;
3772 		}
3773 
3774 		if (sacked & (TCPCB_SACKED_ACKED|TCPCB_SACKED_RETRANS))
3775 			continue;
3776 
3777 		if (tcp_small_queue_check(sk, skb, 1))
3778 			break;
3779 
3780 		if (tcp_retransmit_skb(sk, skb, segs))
3781 			break;
3782 
3783 		NET_ADD_STATS(sock_net(sk), mib_idx, tcp_skb_pcount(skb));
3784 
3785 		if (tcp_in_cwnd_reduction(sk))
3786 			tp->prr_out += tcp_skb_pcount(skb);
3787 
3788 		if (skb == rtx_head &&
3789 		    icsk->icsk_pending != ICSK_TIME_REO_TIMEOUT)
3790 			rearm_timer = true;
3791 
3792 	}
3793 	if (rearm_timer)
3794 		tcp_reset_xmit_timer(sk, ICSK_TIME_RETRANS,
3795 				     inet_csk(sk)->icsk_rto, true);
3796 }
3797 
3798 /* Send a FIN. The caller locks the socket for us.
3799  * We should try to send a FIN packet really hard, but eventually give up.
3800  */
3801 void tcp_send_fin(struct sock *sk)
3802 {
3803 	struct sk_buff *skb, *tskb, *tail = tcp_write_queue_tail(sk);
3804 	struct tcp_sock *tp = tcp_sk(sk);
3805 
3806 	/* Optimization, tack on the FIN if we have one skb in write queue and
3807 	 * this skb was not yet sent, or we are under memory pressure.
3808 	 * Note: in the latter case, FIN packet will be sent after a timeout,
3809 	 * as TCP stack thinks it has already been transmitted.
3810 	 */
3811 	tskb = tail;
3812 	if (!tskb && tcp_under_memory_pressure(sk))
3813 		tskb = skb_rb_last(&sk->tcp_rtx_queue);
3814 
3815 	if (tskb) {
3816 		TCP_SKB_CB(tskb)->tcp_flags |= TCPHDR_FIN;
3817 		TCP_SKB_CB(tskb)->end_seq++;
3818 		tp->write_seq++;
3819 		if (!tail) {
3820 			/* This means tskb was already sent.
3821 			 * Pretend we included the FIN on previous transmit.
3822 			 * We need to set tp->snd_nxt to the value it would have
3823 			 * if FIN had been sent. This is because retransmit path
3824 			 * does not change tp->snd_nxt.
3825 			 */
3826 			WRITE_ONCE(tp->snd_nxt, tp->snd_nxt + 1);
3827 			return;
3828 		}
3829 	} else {
3830 		skb = alloc_skb_fclone(MAX_TCP_HEADER,
3831 				       sk_gfp_mask(sk, GFP_ATOMIC |
3832 						       __GFP_NOWARN));
3833 		if (unlikely(!skb))
3834 			return;
3835 
3836 		INIT_LIST_HEAD(&skb->tcp_tsorted_anchor);
3837 		skb_reserve(skb, MAX_TCP_HEADER);
3838 		sk_forced_mem_schedule(sk, skb->truesize);
3839 		/* FIN eats a sequence byte, write_seq advanced by tcp_queue_skb(). */
3840 		tcp_init_nondata_skb(skb, sk, tp->write_seq,
3841 				     TCPHDR_ACK | TCPHDR_FIN);
3842 		tcp_queue_skb(sk, skb);
3843 	}
3844 	__tcp_push_pending_frames(sk, tcp_current_mss(sk), TCP_NAGLE_OFF);
3845 }
3846 
3847 /* We get here when a process closes a file descriptor (either due to
3848  * an explicit close() or as a byproduct of exit()'ing) and there
3849  * was unread data in the receive queue.  This behavior is recommended
3850  * by RFC 2525, section 2.17.  -DaveM
3851  */
3852 void tcp_send_active_reset(struct sock *sk, gfp_t priority,
3853 			   enum sk_rst_reason reason)
3854 {
3855 	struct sk_buff *skb;
3856 
3857 	TCP_INC_STATS(sock_net(sk), TCP_MIB_OUTRSTS);
3858 
3859 	/* NOTE: No TCP options attached and we never retransmit this. */
3860 	skb = alloc_skb(MAX_TCP_HEADER, priority);
3861 	if (!skb) {
3862 		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPABORTFAILED);
3863 		return;
3864 	}
3865 
3866 	/* Reserve space for headers and prepare control bits. */
3867 	skb_reserve(skb, MAX_TCP_HEADER);
3868 	tcp_init_nondata_skb(skb, sk, tcp_acceptable_seq(sk),
3869 			     TCPHDR_ACK | TCPHDR_RST);
3870 	tcp_mstamp_refresh(tcp_sk(sk));
3871 	/* Send it off. */
3872 	if (tcp_transmit_skb(sk, skb, 0, priority))
3873 		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPABORTFAILED);
3874 
3875 	/* skb of trace_tcp_send_reset() keeps the skb that caused RST,
3876 	 * skb here is different to the troublesome skb, so use NULL
3877 	 */
3878 	trace_tcp_send_reset(sk, NULL, reason);
3879 }
3880 
3881 /* Send a crossed SYN-ACK during socket establishment.
3882  * WARNING: This routine must only be called when we have already sent
3883  * a SYN packet that crossed the incoming SYN that caused this routine
3884  * to get called. If this assumption fails then the initial rcv_wnd
3885  * and rcv_wscale values will not be correct.
3886  */
3887 int tcp_send_synack(struct sock *sk)
3888 {
3889 	struct sk_buff *skb;
3890 
3891 	skb = tcp_rtx_queue_head(sk);
3892 	if (!skb || !(TCP_SKB_CB(skb)->tcp_flags & TCPHDR_SYN)) {
3893 		pr_err("%s: wrong queue state\n", __func__);
3894 		return -EFAULT;
3895 	}
3896 	if (!(TCP_SKB_CB(skb)->tcp_flags & TCPHDR_ACK)) {
3897 		if (skb_cloned(skb)) {
3898 			struct sk_buff *nskb;
3899 
3900 			tcp_skb_tsorted_save(skb) {
3901 				nskb = skb_copy(skb, GFP_ATOMIC);
3902 			} tcp_skb_tsorted_restore(skb);
3903 			if (!nskb)
3904 				return -ENOMEM;
3905 			INIT_LIST_HEAD(&nskb->tcp_tsorted_anchor);
3906 			tcp_highest_sack_replace(sk, skb, nskb);
3907 			tcp_rtx_queue_unlink_and_free(skb, sk);
3908 			__skb_header_release(nskb);
3909 			tcp_rbtree_insert(&sk->tcp_rtx_queue, nskb);
3910 			sk_wmem_queued_add(sk, nskb->truesize);
3911 			sk_mem_charge(sk, nskb->truesize);
3912 			skb = nskb;
3913 		}
3914 
3915 		TCP_SKB_CB(skb)->tcp_flags |= TCPHDR_ACK;
3916 		tcp_ecn_send_synack(sk, skb);
3917 	}
3918 	return tcp_transmit_skb(sk, skb, 1, GFP_ATOMIC);
3919 }
3920 
3921 /**
3922  * tcp_make_synack - Allocate one skb and build a SYNACK packet.
3923  * @sk: listener socket
3924  * @dst: dst entry attached to the SYNACK. It is consumed and caller
3925  *       should not use it again.
3926  * @req: request_sock pointer
3927  * @foc: cookie for tcp fast open
3928  * @synack_type: Type of synack to prepare
3929  * @syn_skb: SYN packet just received.  It could be NULL for rtx case.
3930  */
3931 struct sk_buff *tcp_make_synack(const struct sock *sk, struct dst_entry *dst,
3932 				struct request_sock *req,
3933 				struct tcp_fastopen_cookie *foc,
3934 				enum tcp_synack_type synack_type,
3935 				struct sk_buff *syn_skb)
3936 {
3937 	struct inet_request_sock *ireq = inet_rsk(req);
3938 	const struct tcp_sock *tp = tcp_sk(sk);
3939 	struct tcp_out_options opts;
3940 	struct tcp_key key = {};
3941 	struct sk_buff *skb;
3942 	int tcp_header_size;
3943 	struct tcphdr *th;
3944 	int mss;
3945 	u64 now;
3946 
3947 	skb = alloc_skb(MAX_TCP_HEADER, GFP_ATOMIC);
3948 	if (unlikely(!skb)) {
3949 		dst_release(dst);
3950 		return NULL;
3951 	}
3952 	/* Reserve space for headers. */
3953 	skb_reserve(skb, MAX_TCP_HEADER);
3954 
3955 	switch (synack_type) {
3956 	case TCP_SYNACK_NORMAL:
3957 	case TCP_SYNACK_RETRANS:
3958 		skb_set_owner_edemux(skb, req_to_sk(req));
3959 		break;
3960 	case TCP_SYNACK_COOKIE:
3961 		/* Under synflood, we do not attach skb to a socket,
3962 		 * to avoid false sharing.
3963 		 */
3964 		break;
3965 	case TCP_SYNACK_FASTOPEN:
3966 		/* sk is a const pointer, because we want to express multiple
3967 		 * cpu might call us concurrently.
3968 		 * sk->sk_wmem_alloc in an atomic, we can promote to rw.
3969 		 */
3970 		skb_set_owner_w(skb, (struct sock *)sk);
3971 		break;
3972 	}
3973 	skb_dst_set(skb, dst);
3974 
3975 	mss = tcp_mss_clamp(tp, dst_metric_advmss(dst));
3976 
3977 	memset(&opts, 0, sizeof(opts));
3978 	now = tcp_clock_ns();
3979 #ifdef CONFIG_SYN_COOKIES
3980 	if (unlikely(synack_type == TCP_SYNACK_COOKIE && ireq->tstamp_ok))
3981 		skb_set_delivery_time(skb, cookie_init_timestamp(req, now),
3982 				      SKB_CLOCK_MONOTONIC);
3983 	else
3984 #endif
3985 	{
3986 		skb_set_delivery_time(skb, now, SKB_CLOCK_MONOTONIC);
3987 		if (!tcp_rsk(req)->snt_synack) /* Timestamp first SYNACK */
3988 			tcp_rsk(req)->snt_synack = tcp_skb_timestamp_us(skb);
3989 	}
3990 
3991 #if defined(CONFIG_TCP_MD5SIG) || defined(CONFIG_TCP_AO)
3992 	rcu_read_lock();
3993 #endif
3994 	if (tcp_rsk_used_ao(req)) {
3995 #ifdef CONFIG_TCP_AO
3996 		struct tcp_ao_key *ao_key = NULL;
3997 		u8 keyid = tcp_rsk(req)->ao_keyid;
3998 		u8 rnext = tcp_rsk(req)->ao_rcv_next;
3999 
4000 		ao_key = tcp_sk(sk)->af_specific->ao_lookup(sk, req_to_sk(req),
4001 							    keyid, -1);
4002 		/* If there is no matching key - avoid sending anything,
4003 		 * especially usigned segments. It could try harder and lookup
4004 		 * for another peer-matching key, but the peer has requested
4005 		 * ao_keyid (RFC5925 RNextKeyID), so let's keep it simple here.
4006 		 */
4007 		if (unlikely(!ao_key)) {
4008 			trace_tcp_ao_synack_no_key(sk, keyid, rnext);
4009 			rcu_read_unlock();
4010 			kfree_skb(skb);
4011 			net_warn_ratelimited("TCP-AO: the keyid %u from SYN packet is not present - not sending SYNACK\n",
4012 					     keyid);
4013 			return NULL;
4014 		}
4015 		key.ao_key = ao_key;
4016 		key.type = TCP_KEY_AO;
4017 #endif
4018 	} else {
4019 #ifdef CONFIG_TCP_MD5SIG
4020 		key.md5_key = tcp_rsk(req)->af_specific->req_md5_lookup(sk,
4021 					req_to_sk(req));
4022 		if (key.md5_key)
4023 			key.type = TCP_KEY_MD5;
4024 #endif
4025 	}
4026 	skb_set_hash(skb, READ_ONCE(tcp_rsk(req)->txhash), PKT_HASH_TYPE_L4);
4027 	/* bpf program will be interested in the tcp_flags */
4028 	TCP_SKB_CB(skb)->tcp_flags = TCPHDR_SYN | TCPHDR_ACK;
4029 	tcp_header_size = tcp_synack_options(sk, req, mss, skb, &opts,
4030 					     &key, foc, synack_type, syn_skb)
4031 					+ sizeof(*th);
4032 
4033 	skb_push(skb, tcp_header_size);
4034 	skb_reset_transport_header(skb);
4035 
4036 	th = (struct tcphdr *)skb->data;
4037 	memset(th, 0, sizeof(struct tcphdr));
4038 	th->syn = 1;
4039 	th->ack = 1;
4040 	tcp_ecn_make_synack(req, th, synack_type);
4041 	th->source = htons(ireq->ir_num);
4042 	th->dest = ireq->ir_rmt_port;
4043 	skb->mark = ireq->ir_mark;
4044 	skb->ip_summed = CHECKSUM_PARTIAL;
4045 	th->seq = htonl(tcp_rsk(req)->snt_isn);
4046 	/* XXX data is queued and acked as is. No buffer/window check */
4047 	th->ack_seq = htonl(tcp_rsk(req)->rcv_nxt);
4048 
4049 	/* RFC1323: The window in SYN & SYN/ACK segments is never scaled. */
4050 	th->window = htons(min(req->rsk_rcv_wnd, 65535U));
4051 	tcp_options_write(th, NULL, tcp_rsk(req), &opts, &key);
4052 	th->doff = (tcp_header_size >> 2);
4053 	TCP_INC_STATS(sock_net(sk), TCP_MIB_OUTSEGS);
4054 
4055 	/* Okay, we have all we need - do the md5 hash if needed */
4056 	if (tcp_key_is_md5(&key)) {
4057 #ifdef CONFIG_TCP_MD5SIG
4058 		tcp_rsk(req)->af_specific->calc_md5_hash(opts.hash_location,
4059 					key.md5_key, req_to_sk(req), skb);
4060 #endif
4061 	} else if (tcp_key_is_ao(&key)) {
4062 #ifdef CONFIG_TCP_AO
4063 		tcp_rsk(req)->af_specific->ao_synack_hash(opts.hash_location,
4064 					key.ao_key, req, skb,
4065 					opts.hash_location - (u8 *)th, 0);
4066 #endif
4067 	}
4068 #if defined(CONFIG_TCP_MD5SIG) || defined(CONFIG_TCP_AO)
4069 	rcu_read_unlock();
4070 #endif
4071 
4072 	bpf_skops_write_hdr_opt((struct sock *)sk, skb, req, syn_skb,
4073 				synack_type, &opts);
4074 
4075 	skb_set_delivery_time(skb, now, SKB_CLOCK_MONOTONIC);
4076 	tcp_add_tx_delay(skb, tp);
4077 
4078 	return skb;
4079 }
4080 
4081 static void tcp_ca_dst_init(struct sock *sk, const struct dst_entry *dst)
4082 {
4083 	struct inet_connection_sock *icsk = inet_csk(sk);
4084 	const struct tcp_congestion_ops *ca;
4085 	u32 ca_key = dst_metric(dst, RTAX_CC_ALGO);
4086 
4087 	if (ca_key == TCP_CA_UNSPEC)
4088 		return;
4089 
4090 	rcu_read_lock();
4091 	ca = tcp_ca_find_key(ca_key);
4092 	if (likely(ca && bpf_try_module_get(ca, ca->owner))) {
4093 		bpf_module_put(icsk->icsk_ca_ops, icsk->icsk_ca_ops->owner);
4094 		icsk->icsk_ca_dst_locked = tcp_ca_dst_locked(dst);
4095 		icsk->icsk_ca_ops = ca;
4096 	}
4097 	rcu_read_unlock();
4098 }
4099 
4100 /* Do all connect socket setups that can be done AF independent. */
4101 static void tcp_connect_init(struct sock *sk)
4102 {
4103 	const struct dst_entry *dst = __sk_dst_get(sk);
4104 	struct tcp_sock *tp = tcp_sk(sk);
4105 	__u8 rcv_wscale;
4106 	u16 user_mss;
4107 	u32 rcv_wnd;
4108 
4109 	/* We'll fix this up when we get a response from the other end.
4110 	 * See tcp_input.c:tcp_rcv_state_process case TCP_SYN_SENT.
4111 	 */
4112 	tp->tcp_header_len = sizeof(struct tcphdr);
4113 	if (READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_timestamps))
4114 		tp->tcp_header_len += TCPOLEN_TSTAMP_ALIGNED;
4115 
4116 	tcp_ao_connect_init(sk);
4117 
4118 	/* If user gave his TCP_MAXSEG, record it to clamp */
4119 	user_mss = READ_ONCE(tp->rx_opt.user_mss);
4120 	if (user_mss)
4121 		tp->rx_opt.mss_clamp = user_mss;
4122 	tp->max_window = 0;
4123 	tcp_mtup_init(sk);
4124 	tcp_sync_mss(sk, dst_mtu(dst));
4125 
4126 	tcp_ca_dst_init(sk, dst);
4127 
4128 	if (!tp->window_clamp)
4129 		WRITE_ONCE(tp->window_clamp, dst_metric(dst, RTAX_WINDOW));
4130 	tp->advmss = tcp_mss_clamp(tp, dst_metric_advmss(dst));
4131 
4132 	tcp_initialize_rcv_mss(sk);
4133 
4134 	/* limit the window selection if the user enforce a smaller rx buffer */
4135 	if (sk->sk_userlocks & SOCK_RCVBUF_LOCK &&
4136 	    (tp->window_clamp > tcp_full_space(sk) || tp->window_clamp == 0))
4137 		WRITE_ONCE(tp->window_clamp, tcp_full_space(sk));
4138 
4139 	rcv_wnd = tcp_rwnd_init_bpf(sk);
4140 	if (rcv_wnd == 0)
4141 		rcv_wnd = dst_metric(dst, RTAX_INITRWND);
4142 
4143 	tcp_select_initial_window(sk, tcp_full_space(sk),
4144 				  tp->advmss - (tp->rx_opt.ts_recent_stamp ? tp->tcp_header_len - sizeof(struct tcphdr) : 0),
4145 				  &tp->rcv_wnd,
4146 				  &tp->window_clamp,
4147 				  READ_ONCE(sock_net(sk)->ipv4.sysctl_tcp_window_scaling),
4148 				  &rcv_wscale,
4149 				  rcv_wnd);
4150 
4151 	tp->rx_opt.rcv_wscale = rcv_wscale;
4152 	tp->rcv_ssthresh = tp->rcv_wnd;
4153 
4154 	WRITE_ONCE(sk->sk_err, 0);
4155 	sock_reset_flag(sk, SOCK_DONE);
4156 	tp->snd_wnd = 0;
4157 	tcp_init_wl(tp, 0);
4158 	tcp_write_queue_purge(sk);
4159 	WRITE_ONCE(tp->snd_una, tp->write_seq);
4160 	tp->snd_sml = tp->write_seq;
4161 	tp->snd_up = tp->write_seq;
4162 	WRITE_ONCE(tp->snd_nxt, tp->write_seq);
4163 
4164 	if (likely(!tp->repair))
4165 		tp->rcv_nxt = 0;
4166 	else
4167 		tp->rcv_tstamp = tcp_jiffies32;
4168 	tp->rcv_wup = tp->rcv_nxt;
4169 	tp->rcv_mwnd_seq = tp->rcv_nxt + tp->rcv_wnd;
4170 	WRITE_ONCE(tp->copied_seq, tp->rcv_nxt);
4171 
4172 	inet_csk(sk)->icsk_rto = tcp_timeout_init(sk);
4173 	WRITE_ONCE(inet_csk(sk)->icsk_retransmits, 0);
4174 	tcp_clear_retrans(tp);
4175 }
4176 
4177 static void tcp_connect_queue_skb(struct sock *sk, struct sk_buff *skb)
4178 {
4179 	struct tcp_sock *tp = tcp_sk(sk);
4180 	struct tcp_skb_cb *tcb = TCP_SKB_CB(skb);
4181 
4182 	tcb->end_seq += skb->len;
4183 	__skb_header_release(skb);
4184 	sk_wmem_queued_add(sk, skb->truesize);
4185 	sk_mem_charge(sk, skb->truesize);
4186 	WRITE_ONCE(tp->write_seq, tcb->end_seq);
4187 	tp->packets_out += tcp_skb_pcount(skb);
4188 }
4189 
4190 /* Build and send a SYN with data and (cached) Fast Open cookie. However,
4191  * queue a data-only packet after the regular SYN, such that regular SYNs
4192  * are retransmitted on timeouts. Also if the remote SYN-ACK acknowledges
4193  * only the SYN sequence, the data are retransmitted in the first ACK.
4194  * If cookie is not cached or other error occurs, falls back to send a
4195  * regular SYN with Fast Open cookie request option.
4196  */
4197 static int tcp_send_syn_data(struct sock *sk, struct sk_buff *syn)
4198 {
4199 	struct inet_connection_sock *icsk = inet_csk(sk);
4200 	struct tcp_sock *tp = tcp_sk(sk);
4201 	struct tcp_fastopen_request *fo = tp->fastopen_req;
4202 	struct page_frag *pfrag = sk_page_frag(sk);
4203 	struct sk_buff *syn_data;
4204 	int space, err = 0;
4205 
4206 	tp->rx_opt.mss_clamp = tp->advmss;  /* If MSS is not cached */
4207 	if (!tcp_fastopen_cookie_check(sk, &tp->rx_opt.mss_clamp, &fo->cookie))
4208 		goto fallback;
4209 
4210 	/* MSS for SYN-data is based on cached MSS and bounded by PMTU and
4211 	 * user-MSS. Reserve maximum option space for middleboxes that add
4212 	 * private TCP options. The cost is reduced data space in SYN :(
4213 	 */
4214 	tp->rx_opt.mss_clamp = tcp_mss_clamp(tp, tp->rx_opt.mss_clamp);
4215 	/* Sync mss_cache after updating the mss_clamp */
4216 	tcp_sync_mss(sk, icsk->icsk_pmtu_cookie);
4217 
4218 	space = __tcp_mtu_to_mss(sk, icsk->icsk_pmtu_cookie) -
4219 		MAX_TCP_OPTION_SPACE;
4220 
4221 	space = min_t(size_t, space, fo->size);
4222 
4223 	if (space &&
4224 	    !skb_page_frag_refill(min_t(size_t, space, PAGE_SIZE),
4225 				  pfrag, sk->sk_allocation))
4226 		goto fallback;
4227 	syn_data = tcp_stream_alloc_skb(sk, sk->sk_allocation, false);
4228 	if (!syn_data)
4229 		goto fallback;
4230 	memcpy(syn_data->cb, syn->cb, sizeof(syn->cb));
4231 	if (space) {
4232 		space = min_t(size_t, space, pfrag->size - pfrag->offset);
4233 		space = tcp_wmem_schedule(sk, space);
4234 	}
4235 	if (space) {
4236 		space = copy_page_from_iter(pfrag->page, pfrag->offset,
4237 					    space, &fo->data->msg_iter);
4238 		if (unlikely(!space)) {
4239 			tcp_skb_tsorted_anchor_cleanup(syn_data);
4240 			kfree_skb(syn_data);
4241 			goto fallback;
4242 		}
4243 		skb_fill_page_desc(syn_data, 0, pfrag->page,
4244 				   pfrag->offset, space);
4245 		page_ref_inc(pfrag->page);
4246 		pfrag->offset += space;
4247 		skb_len_add(syn_data, space);
4248 		skb_zcopy_set(syn_data, fo->uarg, NULL);
4249 	}
4250 	/* No more data pending in inet_wait_for_connect() */
4251 	if (space == fo->size)
4252 		fo->data = NULL;
4253 	fo->copied = space;
4254 
4255 	tcp_connect_queue_skb(sk, syn_data);
4256 	if (syn_data->len)
4257 		tcp_chrono_start(sk, TCP_CHRONO_BUSY);
4258 
4259 	err = tcp_transmit_skb(sk, syn_data, 1, sk->sk_allocation);
4260 
4261 	skb_set_delivery_time(syn, syn_data->skb_mstamp_ns, SKB_CLOCK_MONOTONIC);
4262 
4263 	/* Now full SYN+DATA was cloned and sent (or not),
4264 	 * remove the SYN from the original skb (syn_data)
4265 	 * we keep in write queue in case of a retransmit, as we
4266 	 * also have the SYN packet (with no data) in the same queue.
4267 	 */
4268 	TCP_SKB_CB(syn_data)->seq++;
4269 	TCP_SKB_CB(syn_data)->tcp_flags = TCPHDR_ACK | TCPHDR_PSH;
4270 	if (!err) {
4271 		tp->syn_data = (fo->copied > 0);
4272 		tcp_rbtree_insert(&sk->tcp_rtx_queue, syn_data);
4273 		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPORIGDATASENT);
4274 		goto done;
4275 	}
4276 
4277 	/* data was not sent, put it in write_queue */
4278 	__skb_queue_tail(&sk->sk_write_queue, syn_data);
4279 	tp->packets_out -= tcp_skb_pcount(syn_data);
4280 
4281 fallback:
4282 	/* Send a regular SYN with Fast Open cookie request option */
4283 	if (fo->cookie.len > 0)
4284 		fo->cookie.len = 0;
4285 	err = tcp_transmit_skb(sk, syn, 1, sk->sk_allocation);
4286 	if (err)
4287 		tp->syn_fastopen = 0;
4288 done:
4289 	fo->cookie.len = -1;  /* Exclude Fast Open option for SYN retries */
4290 	return err;
4291 }
4292 
4293 /* Build a SYN and send it off. */
4294 int tcp_connect(struct sock *sk)
4295 {
4296 	struct tcp_sock *tp = tcp_sk(sk);
4297 	struct sk_buff *buff;
4298 	int err;
4299 
4300 	tcp_call_bpf(sk, BPF_SOCK_OPS_TCP_CONNECT_CB, 0, NULL);
4301 
4302 #if defined(CONFIG_TCP_MD5SIG) && defined(CONFIG_TCP_AO)
4303 	/* Has to be checked late, after setting daddr/saddr/ops.
4304 	 * Return error if the peer has both a md5 and a tcp-ao key
4305 	 * configured as this is ambiguous.
4306 	 */
4307 	if (unlikely(rcu_dereference_protected(tp->md5sig_info,
4308 					       lockdep_sock_is_held(sk)))) {
4309 		bool needs_ao = !!tp->af_specific->ao_lookup(sk, sk, -1, -1);
4310 		bool needs_md5 = !!tp->af_specific->md5_lookup(sk, sk);
4311 		struct tcp_ao_info *ao_info;
4312 
4313 		ao_info = rcu_dereference_check(tp->ao_info,
4314 						lockdep_sock_is_held(sk));
4315 		if (ao_info) {
4316 			/* This is an extra check: tcp_ao_required() in
4317 			 * tcp_v{4,6}_parse_md5_keys() should prevent adding
4318 			 * md5 keys on ao_required socket.
4319 			 */
4320 			needs_ao |= ao_info->ao_required;
4321 			WARN_ON_ONCE(ao_info->ao_required && needs_md5);
4322 		}
4323 		if (needs_md5 && needs_ao)
4324 			return -EKEYREJECTED;
4325 
4326 		/* If we have a matching md5 key and no matching tcp-ao key
4327 		 * then free up ao_info if allocated.
4328 		 */
4329 		if (needs_md5) {
4330 			tcp_ao_destroy_sock(sk, false);
4331 		} else if (needs_ao) {
4332 			tcp_clear_md5_list(sk);
4333 			kfree(rcu_replace_pointer(tp->md5sig_info, NULL,
4334 						  lockdep_sock_is_held(sk)));
4335 		}
4336 	}
4337 #endif
4338 #ifdef CONFIG_TCP_AO
4339 	if (unlikely(rcu_dereference_protected(tp->ao_info,
4340 					       lockdep_sock_is_held(sk)))) {
4341 		/* Don't allow connecting if ao is configured but no
4342 		 * matching key is found.
4343 		 */
4344 		if (!tp->af_specific->ao_lookup(sk, sk, -1, -1))
4345 			return -EKEYREJECTED;
4346 	}
4347 #endif
4348 
4349 	if (inet_csk(sk)->icsk_af_ops->rebuild_header(sk))
4350 		return -EHOSTUNREACH; /* Routing failure or similar. */
4351 
4352 	tcp_connect_init(sk);
4353 
4354 	if (unlikely(tp->repair)) {
4355 		tcp_finish_connect(sk, NULL);
4356 		return 0;
4357 	}
4358 
4359 	buff = tcp_stream_alloc_skb(sk, sk->sk_allocation, true);
4360 	if (unlikely(!buff))
4361 		return -ENOBUFS;
4362 
4363 	/* SYN eats a sequence byte, write_seq updated by
4364 	 * tcp_connect_queue_skb().
4365 	 */
4366 	tcp_init_nondata_skb(buff, sk, tp->write_seq, TCPHDR_SYN);
4367 	tcp_mstamp_refresh(tp);
4368 	tp->retrans_stamp = tcp_time_stamp_ts(tp);
4369 	tcp_connect_queue_skb(sk, buff);
4370 	tcp_ecn_send_syn(sk, buff);
4371 	tcp_rbtree_insert(&sk->tcp_rtx_queue, buff);
4372 
4373 	/* Send off SYN; include data in Fast Open. */
4374 	err = tp->fastopen_req ? tcp_send_syn_data(sk, buff) :
4375 	      tcp_transmit_skb(sk, buff, 1, sk->sk_allocation);
4376 	if (err == -ECONNREFUSED)
4377 		return err;
4378 
4379 	/* We change tp->snd_nxt after the tcp_transmit_skb() call
4380 	 * in order to make this packet get counted in tcpOutSegs.
4381 	 */
4382 	WRITE_ONCE(tp->snd_nxt, tp->write_seq);
4383 	tp->pushed_seq = tp->write_seq;
4384 	buff = tcp_send_head(sk);
4385 	if (unlikely(buff)) {
4386 		WRITE_ONCE(tp->snd_nxt, TCP_SKB_CB(buff)->seq);
4387 		tp->pushed_seq	= TCP_SKB_CB(buff)->seq;
4388 	}
4389 	TCP_INC_STATS(sock_net(sk), TCP_MIB_ACTIVEOPENS);
4390 
4391 	/* Timer for repeating the SYN until an answer. */
4392 	tcp_reset_xmit_timer(sk, ICSK_TIME_RETRANS,
4393 			     inet_csk(sk)->icsk_rto, false);
4394 	return 0;
4395 }
4396 EXPORT_SYMBOL(tcp_connect);
4397 
4398 u32 tcp_delack_max(const struct sock *sk)
4399 {
4400 	u32 delack_from_rto_min = max(tcp_rto_min(sk), 2) - 1;
4401 
4402 	return min(READ_ONCE(inet_csk(sk)->icsk_delack_max), delack_from_rto_min);
4403 }
4404 
4405 /* Send out a delayed ack, the caller does the policy checking
4406  * to see if we should even be here.  See tcp_input.c:tcp_ack_snd_check()
4407  * for details.
4408  */
4409 void tcp_send_delayed_ack(struct sock *sk)
4410 {
4411 	struct inet_connection_sock *icsk = inet_csk(sk);
4412 	int ato = icsk->icsk_ack.ato;
4413 	unsigned long timeout;
4414 
4415 	if (ato > TCP_DELACK_MIN) {
4416 		const struct tcp_sock *tp = tcp_sk(sk);
4417 		int max_ato = HZ / 2;
4418 
4419 		if (inet_csk_in_pingpong_mode(sk) ||
4420 		    (icsk->icsk_ack.pending & ICSK_ACK_PUSHED))
4421 			max_ato = TCP_DELACK_MAX;
4422 
4423 		/* Slow path, intersegment interval is "high". */
4424 
4425 		/* If some rtt estimate is known, use it to bound delayed ack.
4426 		 * Do not use inet_csk(sk)->icsk_rto here, use results of rtt measurements
4427 		 * directly.
4428 		 */
4429 		if (tp->srtt_us) {
4430 			int rtt = max_t(int, usecs_to_jiffies(tp->srtt_us >> 3),
4431 					TCP_DELACK_MIN);
4432 
4433 			if (rtt < max_ato)
4434 				max_ato = rtt;
4435 		}
4436 
4437 		ato = min(ato, max_ato);
4438 	}
4439 
4440 	ato = min_t(u32, ato, tcp_delack_max(sk));
4441 
4442 	/* Stay within the limit we were given */
4443 	timeout = jiffies + ato;
4444 
4445 	/* Use new timeout only if there wasn't a older one earlier. */
4446 	if (icsk->icsk_ack.pending & ICSK_ACK_TIMER) {
4447 		/* If delack timer is about to expire, send ACK now. */
4448 		if (time_before_eq(icsk_delack_timeout(icsk), jiffies + (ato >> 2))) {
4449 			tcp_send_ack(sk);
4450 			return;
4451 		}
4452 
4453 		if (!time_before(timeout, icsk_delack_timeout(icsk)))
4454 			timeout = icsk_delack_timeout(icsk);
4455 	}
4456 	smp_store_release(&icsk->icsk_ack.pending,
4457 			  icsk->icsk_ack.pending | ICSK_ACK_SCHED | ICSK_ACK_TIMER);
4458 	sk_reset_timer(sk, &icsk->icsk_delack_timer, timeout);
4459 }
4460 
4461 /* This routine sends an ack and also updates the window. */
4462 void __tcp_send_ack(struct sock *sk, u32 rcv_nxt, u16 flags)
4463 {
4464 	struct sk_buff *buff;
4465 
4466 	/* If we have been reset, we may not send again. */
4467 	if (sk->sk_state == TCP_CLOSE)
4468 		return;
4469 
4470 	/* We are not putting this on the write queue, so
4471 	 * tcp_transmit_skb() will set the ownership to this
4472 	 * sock.
4473 	 */
4474 	buff = alloc_skb(MAX_TCP_HEADER,
4475 			 sk_gfp_mask(sk, GFP_ATOMIC | __GFP_NOWARN));
4476 	if (unlikely(!buff)) {
4477 		struct inet_connection_sock *icsk = inet_csk(sk);
4478 		unsigned long delay;
4479 
4480 		delay = TCP_DELACK_MAX << icsk->icsk_ack.retry;
4481 		if (delay < tcp_rto_max(sk))
4482 			icsk->icsk_ack.retry++;
4483 		inet_csk_schedule_ack(sk);
4484 		icsk->icsk_ack.ato = TCP_ATO_MIN;
4485 		tcp_reset_xmit_timer(sk, ICSK_TIME_DACK, delay, false);
4486 		return;
4487 	}
4488 
4489 	/* Reserve space for headers and prepare control bits. */
4490 	skb_reserve(buff, MAX_TCP_HEADER);
4491 	tcp_init_nondata_skb(buff, sk,
4492 			     tcp_acceptable_seq(sk), TCPHDR_ACK | flags);
4493 
4494 	/* We do not want pure acks influencing TCP Small Queues or fq/pacing
4495 	 * too much.
4496 	 * SKB_TRUESIZE(max(1 .. 66, MAX_TCP_HEADER)) is unfortunately ~784
4497 	 */
4498 	skb_set_tcp_pure_ack(buff);
4499 
4500 	/* Send it off, this clears delayed acks for us. */
4501 	__tcp_transmit_skb(sk, buff, 0, (__force gfp_t)0, rcv_nxt);
4502 }
4503 EXPORT_SYMBOL_GPL(__tcp_send_ack);
4504 
4505 void tcp_send_ack(struct sock *sk)
4506 {
4507 	__tcp_send_ack(sk, tcp_sk(sk)->rcv_nxt, 0);
4508 }
4509 
4510 /* This routine sends a packet with an out of date sequence
4511  * number. It assumes the other end will try to ack it.
4512  *
4513  * Question: what should we make while urgent mode?
4514  * 4.4BSD forces sending single byte of data. We cannot send
4515  * out of window data, because we have SND.NXT==SND.MAX...
4516  *
4517  * Current solution: to send TWO zero-length segments in urgent mode:
4518  * one is with SEG.SEQ=SND.UNA to deliver urgent pointer, another is
4519  * out-of-date with SND.UNA-1 to probe window.
4520  */
4521 static int tcp_xmit_probe_skb(struct sock *sk, int urgent, int mib)
4522 {
4523 	struct tcp_sock *tp = tcp_sk(sk);
4524 	struct sk_buff *skb;
4525 
4526 	/* We don't queue it, tcp_transmit_skb() sets ownership. */
4527 	skb = alloc_skb(MAX_TCP_HEADER,
4528 			sk_gfp_mask(sk, GFP_ATOMIC | __GFP_NOWARN));
4529 	if (!skb)
4530 		return -1;
4531 
4532 	/* Reserve space for headers and set control bits. */
4533 	skb_reserve(skb, MAX_TCP_HEADER);
4534 	/* Use a previous sequence.  This should cause the other
4535 	 * end to send an ack.  Don't queue or clone SKB, just
4536 	 * send it.
4537 	 */
4538 	tcp_init_nondata_skb(skb, sk, tp->snd_una - !urgent, TCPHDR_ACK);
4539 	NET_INC_STATS(sock_net(sk), mib);
4540 	return tcp_transmit_skb(sk, skb, 0, (__force gfp_t)0);
4541 }
4542 
4543 /* Called from setsockopt( ... TCP_REPAIR ) */
4544 void tcp_send_window_probe(struct sock *sk)
4545 {
4546 	if (sk->sk_state == TCP_ESTABLISHED) {
4547 		tcp_sk(sk)->snd_wl1 = tcp_sk(sk)->rcv_nxt - 1;
4548 		tcp_mstamp_refresh(tcp_sk(sk));
4549 		tcp_xmit_probe_skb(sk, 0, LINUX_MIB_TCPWINPROBE);
4550 	}
4551 }
4552 
4553 /* Initiate keepalive or window probe from timer. */
4554 int tcp_write_wakeup(struct sock *sk, int mib)
4555 {
4556 	struct tcp_sock *tp = tcp_sk(sk);
4557 	struct sk_buff *skb;
4558 
4559 	if (sk->sk_state == TCP_CLOSE)
4560 		return -1;
4561 
4562 	skb = tcp_send_head(sk);
4563 	if (skb && before(TCP_SKB_CB(skb)->seq, tcp_wnd_end(tp))) {
4564 		int err;
4565 		unsigned int mss = tcp_current_mss(sk);
4566 		unsigned int seg_size = tcp_wnd_end(tp) - TCP_SKB_CB(skb)->seq;
4567 
4568 		if (before(tp->pushed_seq, TCP_SKB_CB(skb)->end_seq))
4569 			tp->pushed_seq = TCP_SKB_CB(skb)->end_seq;
4570 
4571 		/* We are probing the opening of a window
4572 		 * but the window size is != 0
4573 		 * must have been a result SWS avoidance ( sender )
4574 		 */
4575 		if (seg_size < TCP_SKB_CB(skb)->end_seq - TCP_SKB_CB(skb)->seq ||
4576 		    skb->len > mss) {
4577 			seg_size = min(seg_size, mss);
4578 			TCP_SKB_CB(skb)->tcp_flags |= TCPHDR_PSH;
4579 			if (tcp_fragment(sk, TCP_FRAG_IN_WRITE_QUEUE,
4580 					 skb, seg_size, mss, GFP_ATOMIC))
4581 				return -1;
4582 		} else if (!tcp_skb_pcount(skb))
4583 			tcp_set_skb_tso_segs(skb, mss);
4584 
4585 		TCP_SKB_CB(skb)->tcp_flags |= TCPHDR_PSH;
4586 		err = tcp_transmit_skb(sk, skb, 1, GFP_ATOMIC);
4587 		if (!err)
4588 			tcp_event_new_data_sent(sk, skb);
4589 		return err;
4590 	} else {
4591 		if (between(tp->snd_up, tp->snd_una + 1, tp->snd_una + 0xFFFF))
4592 			tcp_xmit_probe_skb(sk, 1, mib);
4593 		return tcp_xmit_probe_skb(sk, 0, mib);
4594 	}
4595 }
4596 
4597 /* A window probe timeout has occurred.  If window is not closed send
4598  * a partial packet else a zero probe.
4599  */
4600 void tcp_send_probe0(struct sock *sk)
4601 {
4602 	struct inet_connection_sock *icsk = inet_csk(sk);
4603 	struct tcp_sock *tp = tcp_sk(sk);
4604 	struct net *net = sock_net(sk);
4605 	unsigned long timeout;
4606 	int err;
4607 
4608 	err = tcp_write_wakeup(sk, LINUX_MIB_TCPWINPROBE);
4609 
4610 	if (tp->packets_out || tcp_write_queue_empty(sk)) {
4611 		/* Cancel probe timer, if it is not required. */
4612 		WRITE_ONCE(icsk->icsk_probes_out, 0);
4613 		icsk->icsk_backoff = 0;
4614 		icsk->icsk_probes_tstamp = 0;
4615 		return;
4616 	}
4617 
4618 	WRITE_ONCE(icsk->icsk_probes_out, icsk->icsk_probes_out + 1);
4619 	if (err <= 0) {
4620 		if (icsk->icsk_backoff < READ_ONCE(net->ipv4.sysctl_tcp_retries2))
4621 			icsk->icsk_backoff++;
4622 		timeout = tcp_probe0_when(sk, tcp_rto_max(sk));
4623 	} else {
4624 		/* If packet was not sent due to local congestion,
4625 		 * Let senders fight for local resources conservatively.
4626 		 */
4627 		timeout = TCP_RESOURCE_PROBE_INTERVAL;
4628 	}
4629 
4630 	timeout = tcp_clamp_probe0_to_user_timeout(sk, timeout);
4631 	tcp_reset_xmit_timer(sk, ICSK_TIME_PROBE0, timeout, true);
4632 }
4633 
4634 int tcp_rtx_synack(const struct sock *sk, struct request_sock *req)
4635 {
4636 	const struct tcp_request_sock_ops *af_ops = tcp_rsk(req)->af_specific;
4637 	struct flowi fl;
4638 	int res;
4639 
4640 	/* Paired with WRITE_ONCE() in sock_setsockopt() */
4641 	if (READ_ONCE(sk->sk_txrehash) == SOCK_TXREHASH_ENABLED)
4642 		WRITE_ONCE(tcp_rsk(req)->txhash, net_tx_rndhash());
4643 	res = af_ops->send_synack(sk, NULL, &fl, req, NULL, TCP_SYNACK_RETRANS,
4644 				  NULL);
4645 	if (!res) {
4646 		TCP_INC_STATS(sock_net(sk), TCP_MIB_RETRANSSEGS);
4647 		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPSYNRETRANS);
4648 		if (unlikely(tcp_passive_fastopen(sk))) {
4649 			/* sk has const attribute because listeners are lockless.
4650 			 * However in this case, we are dealing with a passive fastopen
4651 			 * socket thus we can change total_retrans value.
4652 			 */
4653 			WRITE_ONCE(tcp_sk_rw(sk)->total_retrans,
4654 				   tcp_sk_rw(sk)->total_retrans + 1);
4655 		}
4656 		trace_tcp_retransmit_synack(sk, req);
4657 		WRITE_ONCE(req->num_retrans, req->num_retrans + 1);
4658 	}
4659 	return res;
4660 }
4661