xref: /openbmc/linux/net/mptcp/options.c (revision 07f8252fe0e3c2b6320eeff18bdc5b7fb8845cb3)
1eda7acddSPeter Krystad // SPDX-License-Identifier: GPL-2.0
2eda7acddSPeter Krystad /* Multipath TCP
3eda7acddSPeter Krystad  *
4eda7acddSPeter Krystad  * Copyright (c) 2017 - 2019, Intel Corporation.
5eda7acddSPeter Krystad  */
6eda7acddSPeter Krystad 
7c85adcedSGeliang Tang #define pr_fmt(fmt) "MPTCP: " fmt
8c85adcedSGeliang Tang 
9eda7acddSPeter Krystad #include <linux/kernel.h>
10a24d22b2SEric Biggers #include <crypto/sha2.h>
11eda7acddSPeter Krystad #include <net/tcp.h>
12eda7acddSPeter Krystad #include <net/mptcp.h>
13eda7acddSPeter Krystad #include "protocol.h"
14a877de06SGeliang Tang #include "mib.h"
15eda7acddSPeter Krystad 
1665492c5aSPaolo Abeni static bool mptcp_cap_flag_sha256(u8 flags)
1765492c5aSPaolo Abeni {
1865492c5aSPaolo Abeni 	return (flags & MPTCP_CAP_FLAG_MASK) == MPTCP_CAP_HMAC_SHA256;
1965492c5aSPaolo Abeni }
2065492c5aSPaolo Abeni 
21cfde141eSPaolo Abeni static void mptcp_parse_option(const struct sk_buff *skb,
22cfde141eSPaolo Abeni 			       const unsigned char *ptr, int opsize,
23cfde141eSPaolo Abeni 			       struct mptcp_options_received *mp_opt)
24eda7acddSPeter Krystad {
25eda7acddSPeter Krystad 	u8 subtype = *ptr >> 4;
26648ef4b8SMat Martineau 	int expected_opsize;
27eda7acddSPeter Krystad 	u8 version;
28eda7acddSPeter Krystad 	u8 flags;
295c4a824dSGeliang Tang 	u8 i;
30eda7acddSPeter Krystad 
31eda7acddSPeter Krystad 	switch (subtype) {
32eda7acddSPeter Krystad 	case MPTCPOPT_MP_CAPABLE:
33cc7972eaSChristoph Paasch 		/* strict size checking */
34cc7972eaSChristoph Paasch 		if (!(TCP_SKB_CB(skb)->tcp_flags & TCPHDR_SYN)) {
35cc7972eaSChristoph Paasch 			if (skb->len > tcp_hdr(skb)->doff << 2)
36cc7972eaSChristoph Paasch 				expected_opsize = TCPOLEN_MPTCP_MPC_ACK_DATA;
37cc7972eaSChristoph Paasch 			else
38cc7972eaSChristoph Paasch 				expected_opsize = TCPOLEN_MPTCP_MPC_ACK;
39cc7972eaSChristoph Paasch 		} else {
40cc7972eaSChristoph Paasch 			if (TCP_SKB_CB(skb)->tcp_flags & TCPHDR_ACK)
41cc7972eaSChristoph Paasch 				expected_opsize = TCPOLEN_MPTCP_MPC_SYNACK;
42cc7972eaSChristoph Paasch 			else
43cc7972eaSChristoph Paasch 				expected_opsize = TCPOLEN_MPTCP_MPC_SYN;
44cc7972eaSChristoph Paasch 		}
45cc7972eaSChristoph Paasch 		if (opsize != expected_opsize)
46eda7acddSPeter Krystad 			break;
47eda7acddSPeter Krystad 
48cc7972eaSChristoph Paasch 		/* try to be gentle vs future versions on the initial syn */
49eda7acddSPeter Krystad 		version = *ptr++ & MPTCP_VERSION_MASK;
50cc7972eaSChristoph Paasch 		if (opsize != TCPOLEN_MPTCP_MPC_SYN) {
51eda7acddSPeter Krystad 			if (version != MPTCP_SUPPORTED_VERSION)
52eda7acddSPeter Krystad 				break;
53cc7972eaSChristoph Paasch 		} else if (version < MPTCP_SUPPORTED_VERSION) {
54cc7972eaSChristoph Paasch 			break;
55cc7972eaSChristoph Paasch 		}
56eda7acddSPeter Krystad 
57eda7acddSPeter Krystad 		flags = *ptr++;
5865492c5aSPaolo Abeni 		if (!mptcp_cap_flag_sha256(flags) ||
59eda7acddSPeter Krystad 		    (flags & MPTCP_CAP_EXTENSIBILITY))
60eda7acddSPeter Krystad 			break;
61eda7acddSPeter Krystad 
62eda7acddSPeter Krystad 		/* RFC 6824, Section 3.1:
63eda7acddSPeter Krystad 		 * "For the Checksum Required bit (labeled "A"), if either
64eda7acddSPeter Krystad 		 * host requires the use of checksums, checksums MUST be used.
65eda7acddSPeter Krystad 		 * In other words, the only way for checksums not to be used
66eda7acddSPeter Krystad 		 * is if both hosts in their SYNs set A=0."
67eda7acddSPeter Krystad 		 *
68eda7acddSPeter Krystad 		 * Section 3.3.0:
69eda7acddSPeter Krystad 		 * "If a checksum is not present when its use has been
70eda7acddSPeter Krystad 		 * negotiated, the receiver MUST close the subflow with a RST as
71eda7acddSPeter Krystad 		 * it is considered broken."
72eda7acddSPeter Krystad 		 *
73eda7acddSPeter Krystad 		 * We don't implement DSS checksum - fall back to TCP.
74eda7acddSPeter Krystad 		 */
75eda7acddSPeter Krystad 		if (flags & MPTCP_CAP_CHECKSUM_REQD)
76eda7acddSPeter Krystad 			break;
77eda7acddSPeter Krystad 
78eda7acddSPeter Krystad 		mp_opt->mp_capable = 1;
79cc7972eaSChristoph Paasch 		if (opsize >= TCPOLEN_MPTCP_MPC_SYNACK) {
80eda7acddSPeter Krystad 			mp_opt->sndr_key = get_unaligned_be64(ptr);
81eda7acddSPeter Krystad 			ptr += 8;
82cc7972eaSChristoph Paasch 		}
83cc7972eaSChristoph Paasch 		if (opsize >= TCPOLEN_MPTCP_MPC_ACK) {
84eda7acddSPeter Krystad 			mp_opt->rcvr_key = get_unaligned_be64(ptr);
85eda7acddSPeter Krystad 			ptr += 8;
86eda7acddSPeter Krystad 		}
87cc7972eaSChristoph Paasch 		if (opsize == TCPOLEN_MPTCP_MPC_ACK_DATA) {
88cc7972eaSChristoph Paasch 			/* Section 3.1.:
89cc7972eaSChristoph Paasch 			 * "the data parameters in a MP_CAPABLE are semantically
90cc7972eaSChristoph Paasch 			 * equivalent to those in a DSS option and can be used
91cc7972eaSChristoph Paasch 			 * interchangeably."
92cc7972eaSChristoph Paasch 			 */
93cc7972eaSChristoph Paasch 			mp_opt->dss = 1;
94cc7972eaSChristoph Paasch 			mp_opt->use_map = 1;
95cc7972eaSChristoph Paasch 			mp_opt->mpc_map = 1;
96cc7972eaSChristoph Paasch 			mp_opt->data_len = get_unaligned_be16(ptr);
97cc7972eaSChristoph Paasch 			ptr += 2;
98cc7972eaSChristoph Paasch 		}
99cc7972eaSChristoph Paasch 		pr_debug("MP_CAPABLE version=%x, flags=%x, optlen=%d sndr=%llu, rcvr=%llu len=%d",
100cc7972eaSChristoph Paasch 			 version, flags, opsize, mp_opt->sndr_key,
101cc7972eaSChristoph Paasch 			 mp_opt->rcvr_key, mp_opt->data_len);
102eda7acddSPeter Krystad 		break;
103eda7acddSPeter Krystad 
104f296234cSPeter Krystad 	case MPTCPOPT_MP_JOIN:
105f296234cSPeter Krystad 		mp_opt->mp_join = 1;
106f296234cSPeter Krystad 		if (opsize == TCPOLEN_MPTCP_MPJ_SYN) {
107f296234cSPeter Krystad 			mp_opt->backup = *ptr++ & MPTCPOPT_BACKUP;
108f296234cSPeter Krystad 			mp_opt->join_id = *ptr++;
109f296234cSPeter Krystad 			mp_opt->token = get_unaligned_be32(ptr);
110f296234cSPeter Krystad 			ptr += 4;
111f296234cSPeter Krystad 			mp_opt->nonce = get_unaligned_be32(ptr);
112f296234cSPeter Krystad 			ptr += 4;
113f296234cSPeter Krystad 			pr_debug("MP_JOIN bkup=%u, id=%u, token=%u, nonce=%u",
114f296234cSPeter Krystad 				 mp_opt->backup, mp_opt->join_id,
115f296234cSPeter Krystad 				 mp_opt->token, mp_opt->nonce);
116f296234cSPeter Krystad 		} else if (opsize == TCPOLEN_MPTCP_MPJ_SYNACK) {
117f296234cSPeter Krystad 			mp_opt->backup = *ptr++ & MPTCPOPT_BACKUP;
118f296234cSPeter Krystad 			mp_opt->join_id = *ptr++;
119f296234cSPeter Krystad 			mp_opt->thmac = get_unaligned_be64(ptr);
120f296234cSPeter Krystad 			ptr += 8;
121f296234cSPeter Krystad 			mp_opt->nonce = get_unaligned_be32(ptr);
122f296234cSPeter Krystad 			ptr += 4;
123f296234cSPeter Krystad 			pr_debug("MP_JOIN bkup=%u, id=%u, thmac=%llu, nonce=%u",
124f296234cSPeter Krystad 				 mp_opt->backup, mp_opt->join_id,
125f296234cSPeter Krystad 				 mp_opt->thmac, mp_opt->nonce);
126f296234cSPeter Krystad 		} else if (opsize == TCPOLEN_MPTCP_MPJ_ACK) {
127f296234cSPeter Krystad 			ptr += 2;
128f296234cSPeter Krystad 			memcpy(mp_opt->hmac, ptr, MPTCPOPT_HMAC_LEN);
129f296234cSPeter Krystad 			pr_debug("MP_JOIN hmac");
130f296234cSPeter Krystad 		} else {
131f296234cSPeter Krystad 			pr_warn("MP_JOIN bad option size");
132f296234cSPeter Krystad 			mp_opt->mp_join = 0;
133f296234cSPeter Krystad 		}
134f296234cSPeter Krystad 		break;
135f296234cSPeter Krystad 
136eda7acddSPeter Krystad 	case MPTCPOPT_DSS:
137eda7acddSPeter Krystad 		pr_debug("DSS");
138648ef4b8SMat Martineau 		ptr++;
139648ef4b8SMat Martineau 
140cc7972eaSChristoph Paasch 		/* we must clear 'mpc_map' be able to detect MP_CAPABLE
141cc7972eaSChristoph Paasch 		 * map vs DSS map in mptcp_incoming_options(), and reconstruct
142cc7972eaSChristoph Paasch 		 * map info accordingly
143cc7972eaSChristoph Paasch 		 */
144cc7972eaSChristoph Paasch 		mp_opt->mpc_map = 0;
145648ef4b8SMat Martineau 		flags = (*ptr++) & MPTCP_DSS_FLAG_MASK;
146648ef4b8SMat Martineau 		mp_opt->data_fin = (flags & MPTCP_DSS_DATA_FIN) != 0;
147648ef4b8SMat Martineau 		mp_opt->dsn64 = (flags & MPTCP_DSS_DSN64) != 0;
148648ef4b8SMat Martineau 		mp_opt->use_map = (flags & MPTCP_DSS_HAS_MAP) != 0;
149648ef4b8SMat Martineau 		mp_opt->ack64 = (flags & MPTCP_DSS_ACK64) != 0;
150648ef4b8SMat Martineau 		mp_opt->use_ack = (flags & MPTCP_DSS_HAS_ACK);
151648ef4b8SMat Martineau 
152648ef4b8SMat Martineau 		pr_debug("data_fin=%d dsn64=%d use_map=%d ack64=%d use_ack=%d",
153648ef4b8SMat Martineau 			 mp_opt->data_fin, mp_opt->dsn64,
154648ef4b8SMat Martineau 			 mp_opt->use_map, mp_opt->ack64,
155648ef4b8SMat Martineau 			 mp_opt->use_ack);
156648ef4b8SMat Martineau 
157648ef4b8SMat Martineau 		expected_opsize = TCPOLEN_MPTCP_DSS_BASE;
158648ef4b8SMat Martineau 
159648ef4b8SMat Martineau 		if (mp_opt->use_ack) {
160648ef4b8SMat Martineau 			if (mp_opt->ack64)
161648ef4b8SMat Martineau 				expected_opsize += TCPOLEN_MPTCP_DSS_ACK64;
162648ef4b8SMat Martineau 			else
163648ef4b8SMat Martineau 				expected_opsize += TCPOLEN_MPTCP_DSS_ACK32;
164648ef4b8SMat Martineau 		}
165648ef4b8SMat Martineau 
166648ef4b8SMat Martineau 		if (mp_opt->use_map) {
167648ef4b8SMat Martineau 			if (mp_opt->dsn64)
168648ef4b8SMat Martineau 				expected_opsize += TCPOLEN_MPTCP_DSS_MAP64;
169648ef4b8SMat Martineau 			else
170648ef4b8SMat Martineau 				expected_opsize += TCPOLEN_MPTCP_DSS_MAP32;
171648ef4b8SMat Martineau 		}
172648ef4b8SMat Martineau 
173648ef4b8SMat Martineau 		/* RFC 6824, Section 3.3:
174648ef4b8SMat Martineau 		 * If a checksum is present, but its use had
175648ef4b8SMat Martineau 		 * not been negotiated in the MP_CAPABLE handshake,
176648ef4b8SMat Martineau 		 * the checksum field MUST be ignored.
177648ef4b8SMat Martineau 		 */
178648ef4b8SMat Martineau 		if (opsize != expected_opsize &&
179648ef4b8SMat Martineau 		    opsize != expected_opsize + TCPOLEN_MPTCP_DSS_CHECKSUM)
180648ef4b8SMat Martineau 			break;
181648ef4b8SMat Martineau 
182eda7acddSPeter Krystad 		mp_opt->dss = 1;
183648ef4b8SMat Martineau 
184648ef4b8SMat Martineau 		if (mp_opt->use_ack) {
185648ef4b8SMat Martineau 			if (mp_opt->ack64) {
186648ef4b8SMat Martineau 				mp_opt->data_ack = get_unaligned_be64(ptr);
187648ef4b8SMat Martineau 				ptr += 8;
188648ef4b8SMat Martineau 			} else {
189648ef4b8SMat Martineau 				mp_opt->data_ack = get_unaligned_be32(ptr);
190648ef4b8SMat Martineau 				ptr += 4;
191648ef4b8SMat Martineau 			}
192648ef4b8SMat Martineau 
193648ef4b8SMat Martineau 			pr_debug("data_ack=%llu", mp_opt->data_ack);
194648ef4b8SMat Martineau 		}
195648ef4b8SMat Martineau 
196648ef4b8SMat Martineau 		if (mp_opt->use_map) {
197648ef4b8SMat Martineau 			if (mp_opt->dsn64) {
198648ef4b8SMat Martineau 				mp_opt->data_seq = get_unaligned_be64(ptr);
199648ef4b8SMat Martineau 				ptr += 8;
200648ef4b8SMat Martineau 			} else {
201648ef4b8SMat Martineau 				mp_opt->data_seq = get_unaligned_be32(ptr);
202648ef4b8SMat Martineau 				ptr += 4;
203648ef4b8SMat Martineau 			}
204648ef4b8SMat Martineau 
205648ef4b8SMat Martineau 			mp_opt->subflow_seq = get_unaligned_be32(ptr);
206648ef4b8SMat Martineau 			ptr += 4;
207648ef4b8SMat Martineau 
208648ef4b8SMat Martineau 			mp_opt->data_len = get_unaligned_be16(ptr);
209648ef4b8SMat Martineau 			ptr += 2;
210648ef4b8SMat Martineau 
211648ef4b8SMat Martineau 			pr_debug("data_seq=%llu subflow_seq=%u data_len=%u",
212648ef4b8SMat Martineau 				 mp_opt->data_seq, mp_opt->subflow_seq,
213648ef4b8SMat Martineau 				 mp_opt->data_len);
214648ef4b8SMat Martineau 		}
215648ef4b8SMat Martineau 
216eda7acddSPeter Krystad 		break;
217eda7acddSPeter Krystad 
2183df523abSPeter Krystad 	case MPTCPOPT_ADD_ADDR:
2193df523abSPeter Krystad 		mp_opt->echo = (*ptr++) & MPTCP_ADDR_ECHO;
2203df523abSPeter Krystad 		if (!mp_opt->echo) {
2213df523abSPeter Krystad 			if (opsize == TCPOLEN_MPTCP_ADD_ADDR ||
2223df523abSPeter Krystad 			    opsize == TCPOLEN_MPTCP_ADD_ADDR_PORT)
2231b1a6ef5SGeliang Tang 				mp_opt->addr.family = AF_INET;
2243df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6)
2253df523abSPeter Krystad 			else if (opsize == TCPOLEN_MPTCP_ADD_ADDR6 ||
2263df523abSPeter Krystad 				 opsize == TCPOLEN_MPTCP_ADD_ADDR6_PORT)
2271b1a6ef5SGeliang Tang 				mp_opt->addr.family = AF_INET6;
2283df523abSPeter Krystad #endif
2293df523abSPeter Krystad 			else
2303df523abSPeter Krystad 				break;
2313df523abSPeter Krystad 		} else {
2323df523abSPeter Krystad 			if (opsize == TCPOLEN_MPTCP_ADD_ADDR_BASE ||
2333df523abSPeter Krystad 			    opsize == TCPOLEN_MPTCP_ADD_ADDR_BASE_PORT)
2341b1a6ef5SGeliang Tang 				mp_opt->addr.family = AF_INET;
2353df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6)
2363df523abSPeter Krystad 			else if (opsize == TCPOLEN_MPTCP_ADD_ADDR6_BASE ||
2373df523abSPeter Krystad 				 opsize == TCPOLEN_MPTCP_ADD_ADDR6_BASE_PORT)
2381b1a6ef5SGeliang Tang 				mp_opt->addr.family = AF_INET6;
2393df523abSPeter Krystad #endif
2403df523abSPeter Krystad 			else
2413df523abSPeter Krystad 				break;
2423df523abSPeter Krystad 		}
2433df523abSPeter Krystad 
2443df523abSPeter Krystad 		mp_opt->add_addr = 1;
245f7dafee1SGeliang Tang 		mp_opt->addr.id = *ptr++;
2461b1a6ef5SGeliang Tang 		if (mp_opt->addr.family == AF_INET) {
247f7dafee1SGeliang Tang 			memcpy((u8 *)&mp_opt->addr.addr.s_addr, (u8 *)ptr, 4);
2483df523abSPeter Krystad 			ptr += 4;
2493df523abSPeter Krystad 			if (opsize == TCPOLEN_MPTCP_ADD_ADDR_PORT ||
2503df523abSPeter Krystad 			    opsize == TCPOLEN_MPTCP_ADD_ADDR_BASE_PORT) {
251f7dafee1SGeliang Tang 				mp_opt->addr.port = htons(get_unaligned_be16(ptr));
2523df523abSPeter Krystad 				ptr += 2;
2533df523abSPeter Krystad 			}
2543df523abSPeter Krystad 		}
2553df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6)
2563df523abSPeter Krystad 		else {
257f7dafee1SGeliang Tang 			memcpy(mp_opt->addr.addr6.s6_addr, (u8 *)ptr, 16);
2583df523abSPeter Krystad 			ptr += 16;
2593df523abSPeter Krystad 			if (opsize == TCPOLEN_MPTCP_ADD_ADDR6_PORT ||
2603df523abSPeter Krystad 			    opsize == TCPOLEN_MPTCP_ADD_ADDR6_BASE_PORT) {
261f7dafee1SGeliang Tang 				mp_opt->addr.port = htons(get_unaligned_be16(ptr));
2623df523abSPeter Krystad 				ptr += 2;
2633df523abSPeter Krystad 			}
2643df523abSPeter Krystad 		}
2653df523abSPeter Krystad #endif
2663df523abSPeter Krystad 		if (!mp_opt->echo) {
2673df523abSPeter Krystad 			mp_opt->ahmac = get_unaligned_be64(ptr);
2683df523abSPeter Krystad 			ptr += 8;
2693df523abSPeter Krystad 		}
27090a4aea8SGeliang Tang 		pr_debug("ADD_ADDR%s: id=%d, ahmac=%llu, echo=%d, port=%d",
2711b1a6ef5SGeliang Tang 			 (mp_opt->addr.family == AF_INET6) ? "6" : "",
272f7dafee1SGeliang Tang 			 mp_opt->addr.id, mp_opt->ahmac, mp_opt->echo, ntohs(mp_opt->addr.port));
2733df523abSPeter Krystad 		break;
2743df523abSPeter Krystad 
2753df523abSPeter Krystad 	case MPTCPOPT_RM_ADDR:
2765c4a824dSGeliang Tang 		if (opsize < TCPOLEN_MPTCP_RM_ADDR_BASE + 1 ||
2775c4a824dSGeliang Tang 		    opsize > TCPOLEN_MPTCP_RM_ADDR_BASE + MPTCP_RM_IDS_MAX)
2783df523abSPeter Krystad 			break;
2793df523abSPeter Krystad 
2808e60eed6SGeliang Tang 		ptr++;
2818e60eed6SGeliang Tang 
2823df523abSPeter Krystad 		mp_opt->rm_addr = 1;
2835c4a824dSGeliang Tang 		mp_opt->rm_list.nr = opsize - TCPOLEN_MPTCP_RM_ADDR_BASE;
2845c4a824dSGeliang Tang 		for (i = 0; i < mp_opt->rm_list.nr; i++)
2855c4a824dSGeliang Tang 			mp_opt->rm_list.ids[i] = *ptr++;
2865c4a824dSGeliang Tang 		pr_debug("RM_ADDR: rm_list_nr=%d", mp_opt->rm_list.nr);
2873df523abSPeter Krystad 		break;
2883df523abSPeter Krystad 
28940453a5cSGeliang Tang 	case MPTCPOPT_MP_PRIO:
29040453a5cSGeliang Tang 		if (opsize != TCPOLEN_MPTCP_PRIO)
29140453a5cSGeliang Tang 			break;
29240453a5cSGeliang Tang 
29340453a5cSGeliang Tang 		mp_opt->mp_prio = 1;
29440453a5cSGeliang Tang 		mp_opt->backup = *ptr++ & MPTCP_PRIO_BKUP;
29540453a5cSGeliang Tang 		pr_debug("MP_PRIO: prio=%d", mp_opt->backup);
29640453a5cSGeliang Tang 		break;
29740453a5cSGeliang Tang 
29850c504a2SFlorian Westphal 	case MPTCPOPT_MP_FASTCLOSE:
29950c504a2SFlorian Westphal 		if (opsize != TCPOLEN_MPTCP_FASTCLOSE)
30050c504a2SFlorian Westphal 			break;
30150c504a2SFlorian Westphal 
30250c504a2SFlorian Westphal 		ptr += 2;
30350c504a2SFlorian Westphal 		mp_opt->rcvr_key = get_unaligned_be64(ptr);
30450c504a2SFlorian Westphal 		ptr += 8;
30550c504a2SFlorian Westphal 		mp_opt->fastclose = 1;
30650c504a2SFlorian Westphal 		break;
30750c504a2SFlorian Westphal 
308dc87efdbSFlorian Westphal 	case MPTCPOPT_RST:
309dc87efdbSFlorian Westphal 		if (opsize != TCPOLEN_MPTCP_RST)
310dc87efdbSFlorian Westphal 			break;
311dc87efdbSFlorian Westphal 
312dc87efdbSFlorian Westphal 		if (!(TCP_SKB_CB(skb)->tcp_flags & TCPHDR_RST))
313dc87efdbSFlorian Westphal 			break;
314dc87efdbSFlorian Westphal 		mp_opt->reset = 1;
315dc87efdbSFlorian Westphal 		flags = *ptr++;
316dc87efdbSFlorian Westphal 		mp_opt->reset_transient = flags & MPTCP_RST_TRANSIENT;
317dc87efdbSFlorian Westphal 		mp_opt->reset_reason = *ptr;
318dc87efdbSFlorian Westphal 		break;
319dc87efdbSFlorian Westphal 
320eda7acddSPeter Krystad 	default:
321eda7acddSPeter Krystad 		break;
322eda7acddSPeter Krystad 	}
323eda7acddSPeter Krystad }
324eda7acddSPeter Krystad 
325cec37a6eSPeter Krystad void mptcp_get_options(const struct sk_buff *skb,
326cfde141eSPaolo Abeni 		       struct mptcp_options_received *mp_opt)
327cec37a6eSPeter Krystad {
328cec37a6eSPeter Krystad 	const struct tcphdr *th = tcp_hdr(skb);
329cfde141eSPaolo Abeni 	const unsigned char *ptr;
330cfde141eSPaolo Abeni 	int length;
331cec37a6eSPeter Krystad 
332cfde141eSPaolo Abeni 	/* initialize option status */
333cfde141eSPaolo Abeni 	mp_opt->mp_capable = 0;
334cfde141eSPaolo Abeni 	mp_opt->mp_join = 0;
335cfde141eSPaolo Abeni 	mp_opt->add_addr = 0;
336fe2d9b1aSGeliang Tang 	mp_opt->ahmac = 0;
33750c504a2SFlorian Westphal 	mp_opt->fastclose = 0;
338f7dafee1SGeliang Tang 	mp_opt->addr.port = 0;
339cfde141eSPaolo Abeni 	mp_opt->rm_addr = 0;
340cfde141eSPaolo Abeni 	mp_opt->dss = 0;
34140453a5cSGeliang Tang 	mp_opt->mp_prio = 0;
342dc87efdbSFlorian Westphal 	mp_opt->reset = 0;
343cfde141eSPaolo Abeni 
344cfde141eSPaolo Abeni 	length = (th->doff * 4) - sizeof(struct tcphdr);
345cec37a6eSPeter Krystad 	ptr = (const unsigned char *)(th + 1);
346cec37a6eSPeter Krystad 
347cec37a6eSPeter Krystad 	while (length > 0) {
348cec37a6eSPeter Krystad 		int opcode = *ptr++;
349cec37a6eSPeter Krystad 		int opsize;
350cec37a6eSPeter Krystad 
351cec37a6eSPeter Krystad 		switch (opcode) {
352cec37a6eSPeter Krystad 		case TCPOPT_EOL:
353cec37a6eSPeter Krystad 			return;
354cec37a6eSPeter Krystad 		case TCPOPT_NOP:	/* Ref: RFC 793 section 3.1 */
355cec37a6eSPeter Krystad 			length--;
356cec37a6eSPeter Krystad 			continue;
357cec37a6eSPeter Krystad 		default:
358cec37a6eSPeter Krystad 			opsize = *ptr++;
359cec37a6eSPeter Krystad 			if (opsize < 2) /* "silly options" */
360cec37a6eSPeter Krystad 				return;
361cec37a6eSPeter Krystad 			if (opsize > length)
362cec37a6eSPeter Krystad 				return;	/* don't parse partial options */
363cec37a6eSPeter Krystad 			if (opcode == TCPOPT_MPTCP)
364cfde141eSPaolo Abeni 				mptcp_parse_option(skb, ptr, opsize, mp_opt);
365cec37a6eSPeter Krystad 			ptr += opsize - 2;
366cec37a6eSPeter Krystad 			length -= opsize;
367cec37a6eSPeter Krystad 		}
368cec37a6eSPeter Krystad 	}
369cec37a6eSPeter Krystad }
370cec37a6eSPeter Krystad 
371cc7972eaSChristoph Paasch bool mptcp_syn_options(struct sock *sk, const struct sk_buff *skb,
372cc7972eaSChristoph Paasch 		       unsigned int *size, struct mptcp_out_options *opts)
373cec37a6eSPeter Krystad {
374cec37a6eSPeter Krystad 	struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
375cec37a6eSPeter Krystad 
376cc7972eaSChristoph Paasch 	/* we will use snd_isn to detect first pkt [re]transmission
377cc7972eaSChristoph Paasch 	 * in mptcp_established_options_mp()
378cc7972eaSChristoph Paasch 	 */
379cc7972eaSChristoph Paasch 	subflow->snd_isn = TCP_SKB_CB(skb)->end_seq;
380cec37a6eSPeter Krystad 	if (subflow->request_mptcp) {
381cec37a6eSPeter Krystad 		opts->suboptions = OPTION_MPTCP_MPC_SYN;
382cec37a6eSPeter Krystad 		*size = TCPOLEN_MPTCP_MPC_SYN;
383cec37a6eSPeter Krystad 		return true;
384ec3edaa7SPeter Krystad 	} else if (subflow->request_join) {
385ec3edaa7SPeter Krystad 		pr_debug("remote_token=%u, nonce=%u", subflow->remote_token,
386ec3edaa7SPeter Krystad 			 subflow->local_nonce);
387ec3edaa7SPeter Krystad 		opts->suboptions = OPTION_MPTCP_MPJ_SYN;
388ec3edaa7SPeter Krystad 		opts->join_id = subflow->local_id;
389ec3edaa7SPeter Krystad 		opts->token = subflow->remote_token;
390ec3edaa7SPeter Krystad 		opts->nonce = subflow->local_nonce;
391ec3edaa7SPeter Krystad 		opts->backup = subflow->request_bkup;
392ec3edaa7SPeter Krystad 		*size = TCPOLEN_MPTCP_MPJ_SYN;
393ec3edaa7SPeter Krystad 		return true;
394cec37a6eSPeter Krystad 	}
395cec37a6eSPeter Krystad 	return false;
396cec37a6eSPeter Krystad }
397cec37a6eSPeter Krystad 
398ec3edaa7SPeter Krystad /* MP_JOIN client subflow must wait for 4th ack before sending any data:
399ec3edaa7SPeter Krystad  * TCP can't schedule delack timer before the subflow is fully established.
400ec3edaa7SPeter Krystad  * MPTCP uses the delack timer to do 3rd ack retransmissions
401ec3edaa7SPeter Krystad  */
402ec3edaa7SPeter Krystad static void schedule_3rdack_retransmission(struct sock *sk)
403ec3edaa7SPeter Krystad {
404ec3edaa7SPeter Krystad 	struct inet_connection_sock *icsk = inet_csk(sk);
405ec3edaa7SPeter Krystad 	struct tcp_sock *tp = tcp_sk(sk);
406ec3edaa7SPeter Krystad 	unsigned long timeout;
407ec3edaa7SPeter Krystad 
408ec3edaa7SPeter Krystad 	/* reschedule with a timeout above RTT, as we must look only for drop */
409ec3edaa7SPeter Krystad 	if (tp->srtt_us)
410ec3edaa7SPeter Krystad 		timeout = tp->srtt_us << 1;
411ec3edaa7SPeter Krystad 	else
412ec3edaa7SPeter Krystad 		timeout = TCP_TIMEOUT_INIT;
413ec3edaa7SPeter Krystad 
414ec3edaa7SPeter Krystad 	WARN_ON_ONCE(icsk->icsk_ack.pending & ICSK_ACK_TIMER);
415ec3edaa7SPeter Krystad 	icsk->icsk_ack.pending |= ICSK_ACK_SCHED | ICSK_ACK_TIMER;
416ec3edaa7SPeter Krystad 	icsk->icsk_ack.timeout = timeout;
417ec3edaa7SPeter Krystad 	sk_reset_timer(sk, &icsk->icsk_delack_timer, timeout);
418ec3edaa7SPeter Krystad }
419ec3edaa7SPeter Krystad 
420ec3edaa7SPeter Krystad static void clear_3rdack_retransmission(struct sock *sk)
421ec3edaa7SPeter Krystad {
422ec3edaa7SPeter Krystad 	struct inet_connection_sock *icsk = inet_csk(sk);
423ec3edaa7SPeter Krystad 
424ec3edaa7SPeter Krystad 	sk_stop_timer(sk, &icsk->icsk_delack_timer);
425ec3edaa7SPeter Krystad 	icsk->icsk_ack.timeout = 0;
426ec3edaa7SPeter Krystad 	icsk->icsk_ack.ato = 0;
427ec3edaa7SPeter Krystad 	icsk->icsk_ack.pending &= ~(ICSK_ACK_SCHED | ICSK_ACK_TIMER);
428ec3edaa7SPeter Krystad }
429ec3edaa7SPeter Krystad 
430cc7972eaSChristoph Paasch static bool mptcp_established_options_mp(struct sock *sk, struct sk_buff *skb,
431d87903b6SPaolo Abeni 					 bool snd_data_fin_enable,
432cc7972eaSChristoph Paasch 					 unsigned int *size,
4336d0060f6SMat Martineau 					 unsigned int remaining,
434cec37a6eSPeter Krystad 					 struct mptcp_out_options *opts)
435cec37a6eSPeter Krystad {
436cec37a6eSPeter Krystad 	struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
437cc7972eaSChristoph Paasch 	struct mptcp_ext *mpext;
438cc7972eaSChristoph Paasch 	unsigned int data_len;
439cec37a6eSPeter Krystad 
440ec3edaa7SPeter Krystad 	/* When skb is not available, we better over-estimate the emitted
441ec3edaa7SPeter Krystad 	 * options len. A full DSS option (28 bytes) is longer than
442ec3edaa7SPeter Krystad 	 * TCPOLEN_MPTCP_MPC_ACK_DATA(22) or TCPOLEN_MPTCP_MPJ_ACK(24), so
443ec3edaa7SPeter Krystad 	 * tell the caller to defer the estimate to
444ec3edaa7SPeter Krystad 	 * mptcp_established_options_dss(), which will reserve enough space.
445cc7972eaSChristoph Paasch 	 */
446ec3edaa7SPeter Krystad 	if (!skb)
447ec3edaa7SPeter Krystad 		return false;
448ec3edaa7SPeter Krystad 
449d87903b6SPaolo Abeni 	/* MPC/MPJ needed only on 3rd ack packet, DATA_FIN and TCP shutdown take precedence */
450d87903b6SPaolo Abeni 	if (subflow->fully_established || snd_data_fin_enable ||
451d87903b6SPaolo Abeni 	    subflow->snd_isn != TCP_SKB_CB(skb)->seq ||
452d87903b6SPaolo Abeni 	    sk->sk_state != TCP_ESTABLISHED)
453ec3edaa7SPeter Krystad 		return false;
454ec3edaa7SPeter Krystad 
455ec3edaa7SPeter Krystad 	if (subflow->mp_capable) {
456cc7972eaSChristoph Paasch 		mpext = mptcp_get_ext(skb);
457cc7972eaSChristoph Paasch 		data_len = mpext ? mpext->data_len : 0;
458cc7972eaSChristoph Paasch 
459cc7972eaSChristoph Paasch 		/* we will check ext_copy.data_len in mptcp_write_options() to
460cc7972eaSChristoph Paasch 		 * discriminate between TCPOLEN_MPTCP_MPC_ACK_DATA and
461cc7972eaSChristoph Paasch 		 * TCPOLEN_MPTCP_MPC_ACK
462cc7972eaSChristoph Paasch 		 */
463cc7972eaSChristoph Paasch 		opts->ext_copy.data_len = data_len;
464cec37a6eSPeter Krystad 		opts->suboptions = OPTION_MPTCP_MPC_ACK;
465cec37a6eSPeter Krystad 		opts->sndr_key = subflow->local_key;
466cec37a6eSPeter Krystad 		opts->rcvr_key = subflow->remote_key;
467cc7972eaSChristoph Paasch 
468cc7972eaSChristoph Paasch 		/* Section 3.1.
469cc7972eaSChristoph Paasch 		 * The MP_CAPABLE option is carried on the SYN, SYN/ACK, and ACK
470cc7972eaSChristoph Paasch 		 * packets that start the first subflow of an MPTCP connection,
471cc7972eaSChristoph Paasch 		 * as well as the first packet that carries data
472cc7972eaSChristoph Paasch 		 */
473cc7972eaSChristoph Paasch 		if (data_len > 0)
474cc7972eaSChristoph Paasch 			*size = ALIGN(TCPOLEN_MPTCP_MPC_ACK_DATA, 4);
475cc7972eaSChristoph Paasch 		else
476cec37a6eSPeter Krystad 			*size = TCPOLEN_MPTCP_MPC_ACK;
477cc7972eaSChristoph Paasch 
478cc7972eaSChristoph Paasch 		pr_debug("subflow=%p, local_key=%llu, remote_key=%llu map_len=%d",
479cc7972eaSChristoph Paasch 			 subflow, subflow->local_key, subflow->remote_key,
480cc7972eaSChristoph Paasch 			 data_len);
481cc7972eaSChristoph Paasch 
482cec37a6eSPeter Krystad 		return true;
483ec3edaa7SPeter Krystad 	} else if (subflow->mp_join) {
484ec3edaa7SPeter Krystad 		opts->suboptions = OPTION_MPTCP_MPJ_ACK;
485ec3edaa7SPeter Krystad 		memcpy(opts->hmac, subflow->hmac, MPTCPOPT_HMAC_LEN);
486ec3edaa7SPeter Krystad 		*size = TCPOLEN_MPTCP_MPJ_ACK;
487ec3edaa7SPeter Krystad 		pr_debug("subflow=%p", subflow);
488ec3edaa7SPeter Krystad 
489ec3edaa7SPeter Krystad 		schedule_3rdack_retransmission(sk);
490ec3edaa7SPeter Krystad 		return true;
491cec37a6eSPeter Krystad 	}
492cec37a6eSPeter Krystad 	return false;
493cec37a6eSPeter Krystad }
494cec37a6eSPeter Krystad 
4956d0060f6SMat Martineau static void mptcp_write_data_fin(struct mptcp_subflow_context *subflow,
4969c29e361SPaolo Abeni 				 struct sk_buff *skb, struct mptcp_ext *ext)
4976d0060f6SMat Martineau {
498017512a0SPaolo Abeni 	/* The write_seq value has already been incremented, so the actual
499017512a0SPaolo Abeni 	 * sequence number for the DATA_FIN is one less.
500017512a0SPaolo Abeni 	 */
501017512a0SPaolo Abeni 	u64 data_fin_tx_seq = READ_ONCE(mptcp_sk(subflow->conn)->write_seq) - 1;
5027279da61SMat Martineau 
5039c29e361SPaolo Abeni 	if (!ext->use_map || !skb->len) {
5046d0060f6SMat Martineau 		/* RFC6824 requires a DSS mapping with specific values
5056d0060f6SMat Martineau 		 * if DATA_FIN is set but no data payload is mapped
5066d0060f6SMat Martineau 		 */
5076d37a0b8SMat Martineau 		ext->data_fin = 1;
5086d0060f6SMat Martineau 		ext->use_map = 1;
5096d0060f6SMat Martineau 		ext->dsn64 = 1;
510017512a0SPaolo Abeni 		ext->data_seq = data_fin_tx_seq;
5116d0060f6SMat Martineau 		ext->subflow_seq = 0;
5126d0060f6SMat Martineau 		ext->data_len = 1;
5137279da61SMat Martineau 	} else if (ext->data_seq + ext->data_len == data_fin_tx_seq) {
5146d37a0b8SMat Martineau 		/* If there's an existing DSS mapping and it is the
5156d37a0b8SMat Martineau 		 * final mapping, DATA_FIN consumes 1 additional byte of
5166d37a0b8SMat Martineau 		 * mapping space.
5176d0060f6SMat Martineau 		 */
5186d37a0b8SMat Martineau 		ext->data_fin = 1;
5196d0060f6SMat Martineau 		ext->data_len++;
5206d0060f6SMat Martineau 	}
5216d0060f6SMat Martineau }
5226d0060f6SMat Martineau 
5236d0060f6SMat Martineau static bool mptcp_established_options_dss(struct sock *sk, struct sk_buff *skb,
524d87903b6SPaolo Abeni 					  bool snd_data_fin_enable,
5256d0060f6SMat Martineau 					  unsigned int *size,
5266d0060f6SMat Martineau 					  unsigned int remaining,
5276d0060f6SMat Martineau 					  struct mptcp_out_options *opts)
5286d0060f6SMat Martineau {
5296d0060f6SMat Martineau 	struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
5307279da61SMat Martineau 	struct mptcp_sock *msk = mptcp_sk(subflow->conn);
5316d0060f6SMat Martineau 	unsigned int dss_size = 0;
5326d0060f6SMat Martineau 	struct mptcp_ext *mpext;
5336d0060f6SMat Martineau 	unsigned int ack_size;
534d22f4988SChristoph Paasch 	bool ret = false;
535d87903b6SPaolo Abeni 	u64 ack_seq;
5366d0060f6SMat Martineau 
5370bac966aSMat Martineau 	mpext = skb ? mptcp_get_ext(skb) : NULL;
5386d0060f6SMat Martineau 
5397279da61SMat Martineau 	if (!skb || (mpext && mpext->use_map) || snd_data_fin_enable) {
5406d0060f6SMat Martineau 		unsigned int map_size;
5416d0060f6SMat Martineau 
5426d0060f6SMat Martineau 		map_size = TCPOLEN_MPTCP_DSS_BASE + TCPOLEN_MPTCP_DSS_MAP64;
5436d0060f6SMat Martineau 
5446d0060f6SMat Martineau 		remaining -= map_size;
5456d0060f6SMat Martineau 		dss_size = map_size;
5466d0060f6SMat Martineau 		if (mpext)
5476d0060f6SMat Martineau 			opts->ext_copy = *mpext;
5486d0060f6SMat Martineau 
5497279da61SMat Martineau 		if (skb && snd_data_fin_enable)
5509c29e361SPaolo Abeni 			mptcp_write_data_fin(subflow, skb, &opts->ext_copy);
551d22f4988SChristoph Paasch 		ret = true;
552d22f4988SChristoph Paasch 	}
553d22f4988SChristoph Paasch 
5542398e399SPaolo Abeni 	/* passive sockets msk will set the 'can_ack' after accept(), even
5552398e399SPaolo Abeni 	 * if the first subflow may have the already the remote key handy
5562398e399SPaolo Abeni 	 */
557d22f4988SChristoph Paasch 	opts->ext_copy.use_ack = 0;
558dc093db5SPaolo Abeni 	if (!READ_ONCE(msk->can_ack)) {
559d22f4988SChristoph Paasch 		*size = ALIGN(dss_size, 4);
560d22f4988SChristoph Paasch 		return ret;
5616d0060f6SMat Martineau 	}
5626d0060f6SMat Martineau 
563e3859603SPaolo Abeni 	ack_seq = READ_ONCE(msk->ack_seq);
56437198e93SDavide Caratti 	if (READ_ONCE(msk->use_64bit_ack)) {
5656d0060f6SMat Martineau 		ack_size = TCPOLEN_MPTCP_DSS_ACK64;
566e3859603SPaolo Abeni 		opts->ext_copy.data_ack = ack_seq;
567a0c1d0eaSChristoph Paasch 		opts->ext_copy.ack64 = 1;
568a0c1d0eaSChristoph Paasch 	} else {
569a0c1d0eaSChristoph Paasch 		ack_size = TCPOLEN_MPTCP_DSS_ACK32;
570e3859603SPaolo Abeni 		opts->ext_copy.data_ack32 = (uint32_t)ack_seq;
571a0c1d0eaSChristoph Paasch 		opts->ext_copy.ack64 = 0;
572a0c1d0eaSChristoph Paasch 	}
573a0c1d0eaSChristoph Paasch 	opts->ext_copy.use_ack = 1;
574ea4ca586SPaolo Abeni 	WRITE_ONCE(msk->old_wspace, __mptcp_space((struct sock *)msk));
5756d0060f6SMat Martineau 
5766d0060f6SMat Martineau 	/* Add kind/length/subtype/flag overhead if mapping is not populated */
5776d0060f6SMat Martineau 	if (dss_size == 0)
5786d0060f6SMat Martineau 		ack_size += TCPOLEN_MPTCP_DSS_BASE;
5796d0060f6SMat Martineau 
5806d0060f6SMat Martineau 	dss_size += ack_size;
5816d0060f6SMat Martineau 
5826d0060f6SMat Martineau 	*size = ALIGN(dss_size, 4);
5836d0060f6SMat Martineau 	return true;
5846d0060f6SMat Martineau }
5856d0060f6SMat Martineau 
586761c124eSGeliang Tang static u64 add_addr_generate_hmac(u64 key1, u64 key2,
587761c124eSGeliang Tang 				  struct mptcp_addr_info *addr)
5883df523abSPeter Krystad {
589761c124eSGeliang Tang 	u16 port = ntohs(addr->port);
590bd697222STodd Malsbary 	u8 hmac[SHA256_DIGEST_SIZE];
5913df523abSPeter Krystad 	u8 msg[19];
592761c124eSGeliang Tang 	int i = 0;
5933df523abSPeter Krystad 
594761c124eSGeliang Tang 	msg[i++] = addr->id;
595761c124eSGeliang Tang 	if (addr->family == AF_INET) {
596761c124eSGeliang Tang 		memcpy(&msg[i], &addr->addr.s_addr, 4);
597761c124eSGeliang Tang 		i += 4;
598761c124eSGeliang Tang 	}
599761c124eSGeliang Tang #if IS_ENABLED(CONFIG_MPTCP_IPV6)
600761c124eSGeliang Tang 	else if (addr->family == AF_INET6) {
601761c124eSGeliang Tang 		memcpy(&msg[i], &addr->addr6.s6_addr, 16);
602761c124eSGeliang Tang 		i += 16;
603761c124eSGeliang Tang 	}
604761c124eSGeliang Tang #endif
605761c124eSGeliang Tang 	msg[i++] = port >> 8;
606761c124eSGeliang Tang 	msg[i++] = port & 0xFF;
6073df523abSPeter Krystad 
608761c124eSGeliang Tang 	mptcp_crypto_hmac_sha(key1, key2, msg, i, hmac);
6093df523abSPeter Krystad 
610bd697222STodd Malsbary 	return get_unaligned_be64(&hmac[SHA256_DIGEST_SIZE - sizeof(u64)]);
6113df523abSPeter Krystad }
6123df523abSPeter Krystad 
61384dfe367SGeliang Tang static bool mptcp_established_options_add_addr(struct sock *sk, struct sk_buff *skb,
6143df523abSPeter Krystad 					       unsigned int *size,
6153df523abSPeter Krystad 					       unsigned int remaining,
6163df523abSPeter Krystad 					       struct mptcp_out_options *opts)
6173df523abSPeter Krystad {
6183df523abSPeter Krystad 	struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
6193df523abSPeter Krystad 	struct mptcp_sock *msk = mptcp_sk(subflow->conn);
62084dfe367SGeliang Tang 	bool drop_other_suboptions = false;
62184dfe367SGeliang Tang 	unsigned int opt_size = *size;
6226a6c05a8SGeliang Tang 	bool echo;
6234a2777a8SGeliang Tang 	bool port;
6241b1c7a0eSPeter Krystad 	int len;
6253df523abSPeter Krystad 
626fbe0f87aSGeliang Tang 	if ((mptcp_pm_should_add_signal_ipv6(msk) ||
627*07f8252fSDavide Caratti 	     mptcp_pm_should_add_signal_port(msk) ||
628*07f8252fSDavide Caratti 	     mptcp_pm_should_add_signal_echo(msk)) &&
62984dfe367SGeliang Tang 	    skb && skb_is_tcp_pure_ack(skb)) {
63084dfe367SGeliang Tang 		pr_debug("drop other suboptions");
63184dfe367SGeliang Tang 		opts->suboptions = 0;
6323ae32c07SGeliang Tang 		opts->ext_copy.use_ack = 0;
6333ae32c07SGeliang Tang 		opts->ext_copy.use_map = 0;
63484dfe367SGeliang Tang 		remaining += opt_size;
63584dfe367SGeliang Tang 		drop_other_suboptions = true;
63684dfe367SGeliang Tang 	}
63784dfe367SGeliang Tang 
638f643b803SGeliang Tang 	if (!mptcp_pm_should_add_signal(msk) ||
63930f60baeSGeliang Tang 	    !(mptcp_pm_add_addr_signal(msk, remaining, &opts->addr, &echo, &port)))
6403df523abSPeter Krystad 		return false;
6411b1c7a0eSPeter Krystad 
64230f60baeSGeliang Tang 	len = mptcp_add_addr_len(opts->addr.family, echo, port);
6431b1c7a0eSPeter Krystad 	if (remaining < len)
6441b1c7a0eSPeter Krystad 		return false;
6451b1c7a0eSPeter Krystad 
6461b1c7a0eSPeter Krystad 	*size = len;
64784dfe367SGeliang Tang 	if (drop_other_suboptions)
64884dfe367SGeliang Tang 		*size -= opt_size;
6493df523abSPeter Krystad 	opts->suboptions |= OPTION_MPTCP_ADD_ADDR;
6506a6c05a8SGeliang Tang 	if (!echo) {
6513df523abSPeter Krystad 		opts->ahmac = add_addr_generate_hmac(msk->local_key,
6523df523abSPeter Krystad 						     msk->remote_key,
653761c124eSGeliang Tang 						     &opts->addr);
6543df523abSPeter Krystad 	}
6554a2777a8SGeliang Tang 	pr_debug("addr_id=%d, ahmac=%llu, echo=%d, port=%d",
65630f60baeSGeliang Tang 		 opts->addr.id, opts->ahmac, echo, ntohs(opts->addr.port));
6573df523abSPeter Krystad 
6583df523abSPeter Krystad 	return true;
6593df523abSPeter Krystad }
6603df523abSPeter Krystad 
6615cb104aeSGeliang Tang static bool mptcp_established_options_rm_addr(struct sock *sk,
6625cb104aeSGeliang Tang 					      unsigned int *size,
6635cb104aeSGeliang Tang 					      unsigned int remaining,
6645cb104aeSGeliang Tang 					      struct mptcp_out_options *opts)
6655cb104aeSGeliang Tang {
6665cb104aeSGeliang Tang 	struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
6675cb104aeSGeliang Tang 	struct mptcp_sock *msk = mptcp_sk(subflow->conn);
6686445e17aSGeliang Tang 	struct mptcp_rm_list rm_list;
6696445e17aSGeliang Tang 	int i, len;
6705cb104aeSGeliang Tang 
6715cb104aeSGeliang Tang 	if (!mptcp_pm_should_rm_signal(msk) ||
6726445e17aSGeliang Tang 	    !(mptcp_pm_rm_addr_signal(msk, remaining, &rm_list)))
6735cb104aeSGeliang Tang 		return false;
6745cb104aeSGeliang Tang 
6756445e17aSGeliang Tang 	len = mptcp_rm_addr_len(&rm_list);
6766445e17aSGeliang Tang 	if (len < 0)
6776445e17aSGeliang Tang 		return false;
6786445e17aSGeliang Tang 	if (remaining < len)
6795cb104aeSGeliang Tang 		return false;
6805cb104aeSGeliang Tang 
6816445e17aSGeliang Tang 	*size = len;
6825cb104aeSGeliang Tang 	opts->suboptions |= OPTION_MPTCP_RM_ADDR;
6836445e17aSGeliang Tang 	opts->rm_list = rm_list;
6845cb104aeSGeliang Tang 
6856445e17aSGeliang Tang 	for (i = 0; i < opts->rm_list.nr; i++)
6866445e17aSGeliang Tang 		pr_debug("rm_list_ids[%d]=%d", i, opts->rm_list.ids[i]);
6875cb104aeSGeliang Tang 
6885cb104aeSGeliang Tang 	return true;
6895cb104aeSGeliang Tang }
6905cb104aeSGeliang Tang 
69106706542SGeliang Tang static bool mptcp_established_options_mp_prio(struct sock *sk,
69206706542SGeliang Tang 					      unsigned int *size,
69306706542SGeliang Tang 					      unsigned int remaining,
69406706542SGeliang Tang 					      struct mptcp_out_options *opts)
69506706542SGeliang Tang {
69606706542SGeliang Tang 	struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
69706706542SGeliang Tang 
69806706542SGeliang Tang 	if (!subflow->send_mp_prio)
69906706542SGeliang Tang 		return false;
70006706542SGeliang Tang 
701ec99a470SDavide Caratti 	/* account for the trailing 'nop' option */
702ec99a470SDavide Caratti 	if (remaining < TCPOLEN_MPTCP_PRIO_ALIGN)
70306706542SGeliang Tang 		return false;
70406706542SGeliang Tang 
705ec99a470SDavide Caratti 	*size = TCPOLEN_MPTCP_PRIO_ALIGN;
70606706542SGeliang Tang 	opts->suboptions |= OPTION_MPTCP_PRIO;
70706706542SGeliang Tang 	opts->backup = subflow->request_bkup;
70806706542SGeliang Tang 
70906706542SGeliang Tang 	pr_debug("prio=%d", opts->backup);
71006706542SGeliang Tang 
71106706542SGeliang Tang 	return true;
71206706542SGeliang Tang }
71306706542SGeliang Tang 
714dc87efdbSFlorian Westphal static noinline void mptcp_established_options_rst(struct sock *sk, struct sk_buff *skb,
715dc87efdbSFlorian Westphal 						   unsigned int *size,
716dc87efdbSFlorian Westphal 						   unsigned int remaining,
717dc87efdbSFlorian Westphal 						   struct mptcp_out_options *opts)
718dc87efdbSFlorian Westphal {
719dc87efdbSFlorian Westphal 	const struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
720dc87efdbSFlorian Westphal 
721dc87efdbSFlorian Westphal 	if (remaining < TCPOLEN_MPTCP_RST)
722dc87efdbSFlorian Westphal 		return;
723dc87efdbSFlorian Westphal 
724dc87efdbSFlorian Westphal 	*size = TCPOLEN_MPTCP_RST;
725dc87efdbSFlorian Westphal 	opts->suboptions |= OPTION_MPTCP_RST;
726dc87efdbSFlorian Westphal 	opts->reset_transient = subflow->reset_transient;
727dc87efdbSFlorian Westphal 	opts->reset_reason = subflow->reset_reason;
728dc87efdbSFlorian Westphal }
729dc87efdbSFlorian Westphal 
7306d0060f6SMat Martineau bool mptcp_established_options(struct sock *sk, struct sk_buff *skb,
7316d0060f6SMat Martineau 			       unsigned int *size, unsigned int remaining,
7326d0060f6SMat Martineau 			       struct mptcp_out_options *opts)
7336d0060f6SMat Martineau {
734d87903b6SPaolo Abeni 	struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
735d87903b6SPaolo Abeni 	struct mptcp_sock *msk = mptcp_sk(subflow->conn);
7366d0060f6SMat Martineau 	unsigned int opt_size = 0;
737d87903b6SPaolo Abeni 	bool snd_data_fin;
7386d0060f6SMat Martineau 	bool ret = false;
7396d0060f6SMat Martineau 
7403df523abSPeter Krystad 	opts->suboptions = 0;
7413df523abSPeter Krystad 
742d87903b6SPaolo Abeni 	if (unlikely(__mptcp_check_fallback(msk)))
743e1ff9e82SDavide Caratti 		return false;
744e1ff9e82SDavide Caratti 
745dc87efdbSFlorian Westphal 	if (unlikely(skb && TCP_SKB_CB(skb)->tcp_flags & TCPHDR_RST)) {
746dc87efdbSFlorian Westphal 		mptcp_established_options_rst(sk, skb, size, remaining, opts);
747dc87efdbSFlorian Westphal 		return true;
748dc87efdbSFlorian Westphal 	}
749d5824847SPaolo Abeni 
750d87903b6SPaolo Abeni 	snd_data_fin = mptcp_data_fin_enabled(msk);
751d87903b6SPaolo Abeni 	if (mptcp_established_options_mp(sk, skb, snd_data_fin, &opt_size, remaining, opts))
7526d0060f6SMat Martineau 		ret = true;
753d87903b6SPaolo Abeni 	else if (mptcp_established_options_dss(sk, skb, snd_data_fin, &opt_size, remaining, opts))
7546d0060f6SMat Martineau 		ret = true;
7556d0060f6SMat Martineau 
7566d0060f6SMat Martineau 	/* we reserved enough space for the above options, and exceeding the
7576d0060f6SMat Martineau 	 * TCP option space would be fatal
7586d0060f6SMat Martineau 	 */
7596d0060f6SMat Martineau 	if (WARN_ON_ONCE(opt_size > remaining))
7606d0060f6SMat Martineau 		return false;
7616d0060f6SMat Martineau 
7626d0060f6SMat Martineau 	*size += opt_size;
7636d0060f6SMat Martineau 	remaining -= opt_size;
76484dfe367SGeliang Tang 	if (mptcp_established_options_add_addr(sk, skb, &opt_size, remaining, opts)) {
7653df523abSPeter Krystad 		*size += opt_size;
7663df523abSPeter Krystad 		remaining -= opt_size;
7673df523abSPeter Krystad 		ret = true;
7685cb104aeSGeliang Tang 	} else if (mptcp_established_options_rm_addr(sk, &opt_size, remaining, opts)) {
7695cb104aeSGeliang Tang 		*size += opt_size;
7705cb104aeSGeliang Tang 		remaining -= opt_size;
7715cb104aeSGeliang Tang 		ret = true;
7723df523abSPeter Krystad 	}
7736d0060f6SMat Martineau 
77406706542SGeliang Tang 	if (mptcp_established_options_mp_prio(sk, &opt_size, remaining, opts)) {
77506706542SGeliang Tang 		*size += opt_size;
77606706542SGeliang Tang 		remaining -= opt_size;
77706706542SGeliang Tang 		ret = true;
77806706542SGeliang Tang 	}
77906706542SGeliang Tang 
7806d0060f6SMat Martineau 	return ret;
7816d0060f6SMat Martineau }
7826d0060f6SMat Martineau 
783cec37a6eSPeter Krystad bool mptcp_synack_options(const struct request_sock *req, unsigned int *size,
784cec37a6eSPeter Krystad 			  struct mptcp_out_options *opts)
785cec37a6eSPeter Krystad {
786cec37a6eSPeter Krystad 	struct mptcp_subflow_request_sock *subflow_req = mptcp_subflow_rsk(req);
787cec37a6eSPeter Krystad 
788cec37a6eSPeter Krystad 	if (subflow_req->mp_capable) {
789cec37a6eSPeter Krystad 		opts->suboptions = OPTION_MPTCP_MPC_SYNACK;
790cec37a6eSPeter Krystad 		opts->sndr_key = subflow_req->local_key;
791cec37a6eSPeter Krystad 		*size = TCPOLEN_MPTCP_MPC_SYNACK;
792cec37a6eSPeter Krystad 		pr_debug("subflow_req=%p, local_key=%llu",
793cec37a6eSPeter Krystad 			 subflow_req, subflow_req->local_key);
794cec37a6eSPeter Krystad 		return true;
795f296234cSPeter Krystad 	} else if (subflow_req->mp_join) {
796f296234cSPeter Krystad 		opts->suboptions = OPTION_MPTCP_MPJ_SYNACK;
797f296234cSPeter Krystad 		opts->backup = subflow_req->backup;
798f296234cSPeter Krystad 		opts->join_id = subflow_req->local_id;
799f296234cSPeter Krystad 		opts->thmac = subflow_req->thmac;
800f296234cSPeter Krystad 		opts->nonce = subflow_req->local_nonce;
801f296234cSPeter Krystad 		pr_debug("req=%p, bkup=%u, id=%u, thmac=%llu, nonce=%u",
802f296234cSPeter Krystad 			 subflow_req, opts->backup, opts->join_id,
803f296234cSPeter Krystad 			 opts->thmac, opts->nonce);
804f296234cSPeter Krystad 		*size = TCPOLEN_MPTCP_MPJ_SYNACK;
805f296234cSPeter Krystad 		return true;
806cec37a6eSPeter Krystad 	}
807cec37a6eSPeter Krystad 	return false;
808cec37a6eSPeter Krystad }
809cec37a6eSPeter Krystad 
810d5824847SPaolo Abeni static bool check_fully_established(struct mptcp_sock *msk, struct sock *ssk,
811f296234cSPeter Krystad 				    struct mptcp_subflow_context *subflow,
812d22f4988SChristoph Paasch 				    struct sk_buff *skb,
813d22f4988SChristoph Paasch 				    struct mptcp_options_received *mp_opt)
814d22f4988SChristoph Paasch {
815d22f4988SChristoph Paasch 	/* here we can process OoO, in-window pkts, only in-sequence 4th ack
816f296234cSPeter Krystad 	 * will make the subflow fully established
817d22f4988SChristoph Paasch 	 */
818f296234cSPeter Krystad 	if (likely(subflow->fully_established)) {
819f296234cSPeter Krystad 		/* on passive sockets, check for 3rd ack retransmission
820f296234cSPeter Krystad 		 * note that msk is always set by subflow_syn_recv_sock()
821f296234cSPeter Krystad 		 * for mp_join subflows
822f296234cSPeter Krystad 		 */
823f296234cSPeter Krystad 		if (TCP_SKB_CB(skb)->seq == subflow->ssn_offset + 1 &&
824f296234cSPeter Krystad 		    TCP_SKB_CB(skb)->end_seq == TCP_SKB_CB(skb)->seq &&
825f296234cSPeter Krystad 		    subflow->mp_join && mp_opt->mp_join &&
826f296234cSPeter Krystad 		    READ_ONCE(msk->pm.server_side))
827d5824847SPaolo Abeni 			tcp_send_ack(ssk);
828f296234cSPeter Krystad 		goto fully_established;
829f296234cSPeter Krystad 	}
830d22f4988SChristoph Paasch 
831d5824847SPaolo Abeni 	/* we must process OoO packets before the first subflow is fully
832d5824847SPaolo Abeni 	 * established. OoO packets are instead a protocol violation
833d5824847SPaolo Abeni 	 * for MP_JOIN subflows as the peer must not send any data
834d5824847SPaolo Abeni 	 * before receiving the forth ack - cfr. RFC 8684 section 3.2.
835f296234cSPeter Krystad 	 */
836d5824847SPaolo Abeni 	if (TCP_SKB_CB(skb)->seq != subflow->ssn_offset + 1) {
837d5824847SPaolo Abeni 		if (subflow->mp_join)
838d5824847SPaolo Abeni 			goto reset;
839f296234cSPeter Krystad 		return subflow->mp_capable;
840d5824847SPaolo Abeni 	}
841f296234cSPeter Krystad 
8425a91e32bSPaolo Abeni 	if (mp_opt->dss && mp_opt->use_ack) {
843f296234cSPeter Krystad 		/* subflows are fully established as soon as we get any
844f296234cSPeter Krystad 		 * additional ack.
845f296234cSPeter Krystad 		 */
8460be534f5SPaolo Abeni 		subflow->fully_established = 1;
847b93df08cSPaolo Abeni 		WRITE_ONCE(msk->fully_established, true);
848f296234cSPeter Krystad 		goto fully_established;
849f296234cSPeter Krystad 	}
850d22f4988SChristoph Paasch 
85184dfe367SGeliang Tang 	if (mp_opt->add_addr) {
85284dfe367SGeliang Tang 		WRITE_ONCE(msk->fully_established, true);
85384dfe367SGeliang Tang 		return true;
85484dfe367SGeliang Tang 	}
85584dfe367SGeliang Tang 
856d22f4988SChristoph Paasch 	/* If the first established packet does not contain MP_CAPABLE + data
857d5824847SPaolo Abeni 	 * then fallback to TCP. Fallback scenarios requires a reset for
858d5824847SPaolo Abeni 	 * MP_JOIN subflows.
859d22f4988SChristoph Paasch 	 */
860d22f4988SChristoph Paasch 	if (!mp_opt->mp_capable) {
861d5824847SPaolo Abeni 		if (subflow->mp_join)
862d5824847SPaolo Abeni 			goto reset;
863d22f4988SChristoph Paasch 		subflow->mp_capable = 0;
864e1ff9e82SDavide Caratti 		pr_fallback(msk);
865e1ff9e82SDavide Caratti 		__mptcp_do_fallback(msk);
866d22f4988SChristoph Paasch 		return false;
867d22f4988SChristoph Paasch 	}
868f296234cSPeter Krystad 
869d6085fe1SPaolo Abeni 	if (unlikely(!READ_ONCE(msk->pm.server_side)))
870d6085fe1SPaolo Abeni 		pr_warn_once("bogus mpc option on established client sk");
871b93df08cSPaolo Abeni 	mptcp_subflow_fully_established(subflow, mp_opt);
872f296234cSPeter Krystad 
873f296234cSPeter Krystad fully_established:
8745b950ff4SPaolo Abeni 	/* if the subflow is not already linked into the conn_list, we can't
8755b950ff4SPaolo Abeni 	 * notify the PM: this subflow is still on the listener queue
8765b950ff4SPaolo Abeni 	 * and the PM possibly acquiring the subflow lock could race with
8775b950ff4SPaolo Abeni 	 * the listener close
8785b950ff4SPaolo Abeni 	 */
8795b950ff4SPaolo Abeni 	if (likely(subflow->pm_notified) || list_empty(&subflow->node))
880f296234cSPeter Krystad 		return true;
881f296234cSPeter Krystad 
882f296234cSPeter Krystad 	subflow->pm_notified = 1;
883ec3edaa7SPeter Krystad 	if (subflow->mp_join) {
884d5824847SPaolo Abeni 		clear_3rdack_retransmission(ssk);
88562535200SGeliang Tang 		mptcp_pm_subflow_established(msk);
886ec3edaa7SPeter Krystad 	} else {
8876c714f1bSFlorian Westphal 		mptcp_pm_fully_established(msk, ssk, GFP_ATOMIC);
888ec3edaa7SPeter Krystad 	}
889d22f4988SChristoph Paasch 	return true;
890d5824847SPaolo Abeni 
891d5824847SPaolo Abeni reset:
892d5824847SPaolo Abeni 	mptcp_subflow_reset(ssk);
893d5824847SPaolo Abeni 	return false;
894d22f4988SChristoph Paasch }
895d22f4988SChristoph Paasch 
896cc9d2566SPaolo Abeni static u64 expand_ack(u64 old_ack, u64 cur_ack, bool use_64bit)
897cc9d2566SPaolo Abeni {
898cc9d2566SPaolo Abeni 	u32 old_ack32, cur_ack32;
899cc9d2566SPaolo Abeni 
900cc9d2566SPaolo Abeni 	if (use_64bit)
901cc9d2566SPaolo Abeni 		return cur_ack;
902cc9d2566SPaolo Abeni 
903cc9d2566SPaolo Abeni 	old_ack32 = (u32)old_ack;
904cc9d2566SPaolo Abeni 	cur_ack32 = (u32)cur_ack;
905cc9d2566SPaolo Abeni 	cur_ack = (old_ack & GENMASK_ULL(63, 32)) + cur_ack32;
906cc9d2566SPaolo Abeni 	if (unlikely(before(cur_ack32, old_ack32)))
907cc9d2566SPaolo Abeni 		return cur_ack + (1LL << 32);
908cc9d2566SPaolo Abeni 	return cur_ack;
909cc9d2566SPaolo Abeni }
910cc9d2566SPaolo Abeni 
9116f8a612aSFlorian Westphal static void ack_update_msk(struct mptcp_sock *msk,
9126e628cd3SPaolo Abeni 			   struct sock *ssk,
913cc9d2566SPaolo Abeni 			   struct mptcp_options_received *mp_opt)
914cc9d2566SPaolo Abeni {
9157439d687SPaolo Abeni 	u64 new_wnd_end, new_snd_una, snd_nxt = READ_ONCE(msk->snd_nxt);
9166f8a612aSFlorian Westphal 	struct sock *sk = (struct sock *)msk;
9177439d687SPaolo Abeni 	u64 old_snd_una;
9187439d687SPaolo Abeni 
9197439d687SPaolo Abeni 	mptcp_data_lock(sk);
920cc9d2566SPaolo Abeni 
921cc9d2566SPaolo Abeni 	/* avoid ack expansion on update conflict, to reduce the risk of
922cc9d2566SPaolo Abeni 	 * wrongly expanding to a future ack sequence number, which is way
923cc9d2566SPaolo Abeni 	 * more dangerous than missing an ack
924cc9d2566SPaolo Abeni 	 */
9257439d687SPaolo Abeni 	old_snd_una = msk->snd_una;
926cc9d2566SPaolo Abeni 	new_snd_una = expand_ack(old_snd_una, mp_opt->data_ack, mp_opt->ack64);
927cc9d2566SPaolo Abeni 
928cc9d2566SPaolo Abeni 	/* ACK for data not even sent yet? Ignore. */
929eaa2ffabSPaolo Abeni 	if (after64(new_snd_una, snd_nxt))
930cc9d2566SPaolo Abeni 		new_snd_una = old_snd_una;
931cc9d2566SPaolo Abeni 
9326f8a612aSFlorian Westphal 	new_wnd_end = new_snd_una + tcp_sk(ssk)->snd_wnd;
9336f8a612aSFlorian Westphal 
934219d0499SPaolo Abeni 	if (after64(new_wnd_end, msk->wnd_end))
9357439d687SPaolo Abeni 		msk->wnd_end = new_wnd_end;
936219d0499SPaolo Abeni 
937219d0499SPaolo Abeni 	/* this assumes mptcp_incoming_options() is invoked after tcp_ack() */
938d09d818eSPaolo Abeni 	if (after64(msk->wnd_end, READ_ONCE(msk->snd_nxt)))
939219d0499SPaolo Abeni 		__mptcp_check_push(sk, ssk);
9406f8a612aSFlorian Westphal 
9417439d687SPaolo Abeni 	if (after64(new_snd_una, old_snd_una)) {
9427439d687SPaolo Abeni 		msk->snd_una = new_snd_una;
9437439d687SPaolo Abeni 		__mptcp_data_acked(sk);
944cc9d2566SPaolo Abeni 	}
9457439d687SPaolo Abeni 	mptcp_data_unlock(sk);
946b51f9b80SPaolo Abeni }
947cc9d2566SPaolo Abeni 
9481a49b2c2SMat Martineau bool mptcp_update_rcv_data_fin(struct mptcp_sock *msk, u64 data_fin_seq, bool use_64bit)
9493721b9b6SMat Martineau {
9503721b9b6SMat Martineau 	/* Skip if DATA_FIN was already received.
9513721b9b6SMat Martineau 	 * If updating simultaneously with the recvmsg loop, values
9523721b9b6SMat Martineau 	 * should match. If they mismatch, the peer is misbehaving and
9533721b9b6SMat Martineau 	 * we will prefer the most recent information.
9543721b9b6SMat Martineau 	 */
955781bf13dSPaolo Abeni 	if (READ_ONCE(msk->rcv_data_fin))
9563721b9b6SMat Martineau 		return false;
9573721b9b6SMat Martineau 
9581a49b2c2SMat Martineau 	WRITE_ONCE(msk->rcv_data_fin_seq,
9591a49b2c2SMat Martineau 		   expand_ack(READ_ONCE(msk->ack_seq), data_fin_seq, use_64bit));
9603721b9b6SMat Martineau 	WRITE_ONCE(msk->rcv_data_fin, 1);
9613721b9b6SMat Martineau 
9623721b9b6SMat Martineau 	return true;
9633721b9b6SMat Martineau }
9643721b9b6SMat Martineau 
9651b1c7a0eSPeter Krystad static bool add_addr_hmac_valid(struct mptcp_sock *msk,
9661b1c7a0eSPeter Krystad 				struct mptcp_options_received *mp_opt)
9671b1c7a0eSPeter Krystad {
9681b1c7a0eSPeter Krystad 	u64 hmac = 0;
9691b1c7a0eSPeter Krystad 
9701b1c7a0eSPeter Krystad 	if (mp_opt->echo)
9711b1c7a0eSPeter Krystad 		return true;
9721b1c7a0eSPeter Krystad 
9731b1c7a0eSPeter Krystad 	hmac = add_addr_generate_hmac(msk->remote_key,
9741b1c7a0eSPeter Krystad 				      msk->local_key,
975761c124eSGeliang Tang 				      &mp_opt->addr);
9761b1c7a0eSPeter Krystad 
9771b1c7a0eSPeter Krystad 	pr_debug("msk=%p, ahmac=%llu, mp_opt->ahmac=%llu\n",
9781b1c7a0eSPeter Krystad 		 msk, (unsigned long long)hmac,
9791b1c7a0eSPeter Krystad 		 (unsigned long long)mp_opt->ahmac);
9801b1c7a0eSPeter Krystad 
9811b1c7a0eSPeter Krystad 	return hmac == mp_opt->ahmac;
9821b1c7a0eSPeter Krystad }
9831b1c7a0eSPeter Krystad 
98477d0cab9SFlorian Westphal void mptcp_incoming_options(struct sock *sk, struct sk_buff *skb)
985648ef4b8SMat Martineau {
986d22f4988SChristoph Paasch 	struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
9871b1c7a0eSPeter Krystad 	struct mptcp_sock *msk = mptcp_sk(subflow->conn);
988cfde141eSPaolo Abeni 	struct mptcp_options_received mp_opt;
989648ef4b8SMat Martineau 	struct mptcp_ext *mpext;
990648ef4b8SMat Martineau 
9916e628cd3SPaolo Abeni 	if (__mptcp_check_fallback(msk)) {
9926e628cd3SPaolo Abeni 		/* Keep it simple and unconditionally trigger send data cleanup and
9936e628cd3SPaolo Abeni 		 * pending queue spooling. We will need to acquire the data lock
9946e628cd3SPaolo Abeni 		 * for more accurate checks, and once the lock is acquired, such
9956e628cd3SPaolo Abeni 		 * helpers are cheap.
9966e628cd3SPaolo Abeni 		 */
9976e628cd3SPaolo Abeni 		mptcp_data_lock(subflow->conn);
998219d0499SPaolo Abeni 		if (sk_stream_memory_free(sk))
999219d0499SPaolo Abeni 			__mptcp_check_push(subflow->conn, sk);
10006e628cd3SPaolo Abeni 		__mptcp_data_acked(subflow->conn);
10016e628cd3SPaolo Abeni 		mptcp_data_unlock(subflow->conn);
1002e1ff9e82SDavide Caratti 		return;
10036e628cd3SPaolo Abeni 	}
1004e1ff9e82SDavide Caratti 
1005cfde141eSPaolo Abeni 	mptcp_get_options(skb, &mp_opt);
1006cfde141eSPaolo Abeni 	if (!check_fully_established(msk, sk, subflow, skb, &mp_opt))
1007d22f4988SChristoph Paasch 		return;
1008648ef4b8SMat Martineau 
100950c504a2SFlorian Westphal 	if (mp_opt.fastclose &&
101050c504a2SFlorian Westphal 	    msk->local_key == mp_opt.rcvr_key) {
101150c504a2SFlorian Westphal 		WRITE_ONCE(msk->rcv_fastclose, true);
101250c504a2SFlorian Westphal 		mptcp_schedule_work((struct sock *)msk);
101350c504a2SFlorian Westphal 	}
101450c504a2SFlorian Westphal 
1015cfde141eSPaolo Abeni 	if (mp_opt.add_addr && add_addr_hmac_valid(msk, &mp_opt)) {
1016a877de06SGeliang Tang 		if (!mp_opt.echo) {
1017f7dafee1SGeliang Tang 			mptcp_pm_add_addr_received(msk, &mp_opt.addr);
1018a877de06SGeliang Tang 			MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_ADDADDR);
1019a877de06SGeliang Tang 		} else {
1020f7dafee1SGeliang Tang 			mptcp_pm_add_addr_echoed(msk, &mp_opt.addr);
1021f7dafee1SGeliang Tang 			mptcp_pm_del_add_timer(msk, &mp_opt.addr);
1022a877de06SGeliang Tang 			MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_ECHOADD);
1023a877de06SGeliang Tang 		}
10242fbdd9eaSGeliang Tang 
1025f7dafee1SGeliang Tang 		if (mp_opt.addr.port)
10262fbdd9eaSGeliang Tang 			MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_PORTADD);
10272fbdd9eaSGeliang Tang 
1028cfde141eSPaolo Abeni 		mp_opt.add_addr = 0;
10291b1c7a0eSPeter Krystad 	}
10301b1c7a0eSPeter Krystad 
1031d0876b22SGeliang Tang 	if (mp_opt.rm_addr) {
10325c4a824dSGeliang Tang 		mptcp_pm_rm_addr_received(msk, &mp_opt.rm_list);
1033d0876b22SGeliang Tang 		mp_opt.rm_addr = 0;
1034d0876b22SGeliang Tang 	}
1035d0876b22SGeliang Tang 
103640453a5cSGeliang Tang 	if (mp_opt.mp_prio) {
103740453a5cSGeliang Tang 		mptcp_pm_mp_prio_received(sk, mp_opt.backup);
10380be2ac28SGeliang Tang 		MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_MPPRIORX);
103940453a5cSGeliang Tang 		mp_opt.mp_prio = 0;
104040453a5cSGeliang Tang 	}
104140453a5cSGeliang Tang 
1042dc87efdbSFlorian Westphal 	if (mp_opt.reset) {
1043dc87efdbSFlorian Westphal 		subflow->reset_seen = 1;
1044dc87efdbSFlorian Westphal 		subflow->reset_reason = mp_opt.reset_reason;
1045dc87efdbSFlorian Westphal 		subflow->reset_transient = mp_opt.reset_transient;
1046dc87efdbSFlorian Westphal 	}
1047dc87efdbSFlorian Westphal 
1048cfde141eSPaolo Abeni 	if (!mp_opt.dss)
1049648ef4b8SMat Martineau 		return;
1050648ef4b8SMat Martineau 
1051cc9d2566SPaolo Abeni 	/* we can't wait for recvmsg() to update the ack_seq, otherwise
1052cc9d2566SPaolo Abeni 	 * monodirectional flows will stuck
1053cc9d2566SPaolo Abeni 	 */
1054cfde141eSPaolo Abeni 	if (mp_opt.use_ack)
10556f8a612aSFlorian Westphal 		ack_update_msk(msk, sk, &mp_opt);
1056cc9d2566SPaolo Abeni 
105706827b34SMat Martineau 	/* Zero-data-length packets are dropped by the caller and not
105806827b34SMat Martineau 	 * propagated to the MPTCP layer, so the skb extension does not
105906827b34SMat Martineau 	 * need to be allocated or populated. DATA_FIN information, if
106006827b34SMat Martineau 	 * present, needs to be updated here before the skb is freed.
106143b54c6eSMat Martineau 	 */
106243b54c6eSMat Martineau 	if (TCP_SKB_CB(skb)->seq == TCP_SKB_CB(skb)->end_seq) {
106343b54c6eSMat Martineau 		if (mp_opt.data_fin && mp_opt.data_len == 1 &&
10641a49b2c2SMat Martineau 		    mptcp_update_rcv_data_fin(msk, mp_opt.data_seq, mp_opt.dsn64) &&
106543b54c6eSMat Martineau 		    schedule_work(&msk->work))
106643b54c6eSMat Martineau 			sock_hold(subflow->conn);
106706827b34SMat Martineau 
106806827b34SMat Martineau 		return;
106943b54c6eSMat Martineau 	}
107043b54c6eSMat Martineau 
1071648ef4b8SMat Martineau 	mpext = skb_ext_add(skb, SKB_EXT_MPTCP);
1072648ef4b8SMat Martineau 	if (!mpext)
1073648ef4b8SMat Martineau 		return;
1074648ef4b8SMat Martineau 
1075648ef4b8SMat Martineau 	memset(mpext, 0, sizeof(*mpext));
1076648ef4b8SMat Martineau 
1077cfde141eSPaolo Abeni 	if (mp_opt.use_map) {
1078cfde141eSPaolo Abeni 		if (mp_opt.mpc_map) {
1079cc7972eaSChristoph Paasch 			/* this is an MP_CAPABLE carrying MPTCP data
1080cc7972eaSChristoph Paasch 			 * we know this map the first chunk of data
1081cc7972eaSChristoph Paasch 			 */
1082cc7972eaSChristoph Paasch 			mptcp_crypto_key_sha(subflow->remote_key, NULL,
1083cc7972eaSChristoph Paasch 					     &mpext->data_seq);
1084cc7972eaSChristoph Paasch 			mpext->data_seq++;
1085cc7972eaSChristoph Paasch 			mpext->subflow_seq = 1;
1086cc7972eaSChristoph Paasch 			mpext->dsn64 = 1;
1087cc7972eaSChristoph Paasch 			mpext->mpc_map = 1;
1088a77895dbSPaolo Abeni 			mpext->data_fin = 0;
1089cc7972eaSChristoph Paasch 		} else {
1090cfde141eSPaolo Abeni 			mpext->data_seq = mp_opt.data_seq;
1091cfde141eSPaolo Abeni 			mpext->subflow_seq = mp_opt.subflow_seq;
1092cfde141eSPaolo Abeni 			mpext->dsn64 = mp_opt.dsn64;
1093cfde141eSPaolo Abeni 			mpext->data_fin = mp_opt.data_fin;
1094cc7972eaSChristoph Paasch 		}
1095cfde141eSPaolo Abeni 		mpext->data_len = mp_opt.data_len;
1096648ef4b8SMat Martineau 		mpext->use_map = 1;
1097648ef4b8SMat Martineau 	}
1098648ef4b8SMat Martineau }
1099648ef4b8SMat Martineau 
1100fa3fe2b1SFlorian Westphal static void mptcp_set_rwin(const struct tcp_sock *tp)
1101fa3fe2b1SFlorian Westphal {
1102fa3fe2b1SFlorian Westphal 	const struct sock *ssk = (const struct sock *)tp;
1103fa3fe2b1SFlorian Westphal 	const struct mptcp_subflow_context *subflow;
1104fa3fe2b1SFlorian Westphal 	struct mptcp_sock *msk;
1105fa3fe2b1SFlorian Westphal 	u64 ack_seq;
1106fa3fe2b1SFlorian Westphal 
1107fa3fe2b1SFlorian Westphal 	subflow = mptcp_subflow_ctx(ssk);
1108fa3fe2b1SFlorian Westphal 	msk = mptcp_sk(subflow->conn);
1109fa3fe2b1SFlorian Westphal 
1110fa3fe2b1SFlorian Westphal 	ack_seq = READ_ONCE(msk->ack_seq) + tp->rcv_wnd;
1111fa3fe2b1SFlorian Westphal 
1112fa3fe2b1SFlorian Westphal 	if (after64(ack_seq, READ_ONCE(msk->rcv_wnd_sent)))
1113fa3fe2b1SFlorian Westphal 		WRITE_ONCE(msk->rcv_wnd_sent, ack_seq);
1114fa3fe2b1SFlorian Westphal }
1115fa3fe2b1SFlorian Westphal 
1116fa3fe2b1SFlorian Westphal void mptcp_write_options(__be32 *ptr, const struct tcp_sock *tp,
1117fa3fe2b1SFlorian Westphal 			 struct mptcp_out_options *opts)
1118eda7acddSPeter Krystad {
1119cc7972eaSChristoph Paasch 	if ((OPTION_MPTCP_MPC_SYN | OPTION_MPTCP_MPC_SYNACK |
1120eda7acddSPeter Krystad 	     OPTION_MPTCP_MPC_ACK) & opts->suboptions) {
1121eda7acddSPeter Krystad 		u8 len;
1122eda7acddSPeter Krystad 
1123eda7acddSPeter Krystad 		if (OPTION_MPTCP_MPC_SYN & opts->suboptions)
1124eda7acddSPeter Krystad 			len = TCPOLEN_MPTCP_MPC_SYN;
1125cec37a6eSPeter Krystad 		else if (OPTION_MPTCP_MPC_SYNACK & opts->suboptions)
1126cec37a6eSPeter Krystad 			len = TCPOLEN_MPTCP_MPC_SYNACK;
1127cc7972eaSChristoph Paasch 		else if (opts->ext_copy.data_len)
1128cc7972eaSChristoph Paasch 			len = TCPOLEN_MPTCP_MPC_ACK_DATA;
1129eda7acddSPeter Krystad 		else
1130eda7acddSPeter Krystad 			len = TCPOLEN_MPTCP_MPC_ACK;
1131eda7acddSPeter Krystad 
11323df523abSPeter Krystad 		*ptr++ = mptcp_option(MPTCPOPT_MP_CAPABLE, len,
11333df523abSPeter Krystad 				      MPTCP_SUPPORTED_VERSION,
113465492c5aSPaolo Abeni 				      MPTCP_CAP_HMAC_SHA256);
1135cc7972eaSChristoph Paasch 
1136cc7972eaSChristoph Paasch 		if (!((OPTION_MPTCP_MPC_SYNACK | OPTION_MPTCP_MPC_ACK) &
1137cc7972eaSChristoph Paasch 		    opts->suboptions))
1138cc7972eaSChristoph Paasch 			goto mp_capable_done;
1139cc7972eaSChristoph Paasch 
1140eda7acddSPeter Krystad 		put_unaligned_be64(opts->sndr_key, ptr);
1141eda7acddSPeter Krystad 		ptr += 2;
1142cc7972eaSChristoph Paasch 		if (!((OPTION_MPTCP_MPC_ACK) & opts->suboptions))
1143cc7972eaSChristoph Paasch 			goto mp_capable_done;
1144cc7972eaSChristoph Paasch 
1145eda7acddSPeter Krystad 		put_unaligned_be64(opts->rcvr_key, ptr);
1146eda7acddSPeter Krystad 		ptr += 2;
1147cc7972eaSChristoph Paasch 		if (!opts->ext_copy.data_len)
1148cc7972eaSChristoph Paasch 			goto mp_capable_done;
1149cc7972eaSChristoph Paasch 
1150cc7972eaSChristoph Paasch 		put_unaligned_be32(opts->ext_copy.data_len << 16 |
1151cc7972eaSChristoph Paasch 				   TCPOPT_NOP << 8 | TCPOPT_NOP, ptr);
1152cc7972eaSChristoph Paasch 		ptr += 1;
1153eda7acddSPeter Krystad 	}
11546d0060f6SMat Martineau 
1155cc7972eaSChristoph Paasch mp_capable_done:
1156fef6b7ecSGeliang Tang 	if (OPTION_MPTCP_ADD_ADDR & opts->suboptions) {
11576eb3d1e3SGeliang Tang 		u8 len = TCPOLEN_MPTCP_ADD_ADDR_BASE;
11586eb3d1e3SGeliang Tang 		u8 echo = MPTCP_ADDR_ECHO;
11593df523abSPeter Krystad 
11603df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6)
1161fef6b7ecSGeliang Tang 		if (opts->addr.family == AF_INET6)
1162e1ef6832SGeliang Tang 			len = TCPOLEN_MPTCP_ADD_ADDR6_BASE;
1163e1ef6832SGeliang Tang #endif
1164e1ef6832SGeliang Tang 
116530f60baeSGeliang Tang 		if (opts->addr.port)
116622fb85ffSGeliang Tang 			len += TCPOLEN_MPTCP_PORT_LEN;
116722fb85ffSGeliang Tang 
11686eb3d1e3SGeliang Tang 		if (opts->ahmac) {
11696eb3d1e3SGeliang Tang 			len += sizeof(opts->ahmac);
11706eb3d1e3SGeliang Tang 			echo = 0;
11716eb3d1e3SGeliang Tang 		}
11726eb3d1e3SGeliang Tang 
11733df523abSPeter Krystad 		*ptr++ = mptcp_option(MPTCPOPT_ADD_ADDR,
117430f60baeSGeliang Tang 				      len, echo, opts->addr.id);
1175fef6b7ecSGeliang Tang 		if (opts->addr.family == AF_INET) {
117630f60baeSGeliang Tang 			memcpy((u8 *)ptr, (u8 *)&opts->addr.addr.s_addr, 4);
11773df523abSPeter Krystad 			ptr += 1;
11783df523abSPeter Krystad 		}
11793df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6)
1180fef6b7ecSGeliang Tang 		else if (opts->addr.family == AF_INET6) {
118130f60baeSGeliang Tang 			memcpy((u8 *)ptr, opts->addr.addr6.s6_addr, 16);
11823df523abSPeter Krystad 			ptr += 4;
1183e1ef6832SGeliang Tang 		}
1184e1ef6832SGeliang Tang #endif
118522fb85ffSGeliang Tang 
118630f60baeSGeliang Tang 		if (!opts->addr.port) {
11873df523abSPeter Krystad 			if (opts->ahmac) {
11883df523abSPeter Krystad 				put_unaligned_be64(opts->ahmac, ptr);
11893df523abSPeter Krystad 				ptr += 2;
11903df523abSPeter Krystad 			}
119122fb85ffSGeliang Tang 		} else {
119230f60baeSGeliang Tang 			u16 port = ntohs(opts->addr.port);
119330f60baeSGeliang Tang 
119422fb85ffSGeliang Tang 			if (opts->ahmac) {
119522fb85ffSGeliang Tang 				u8 *bptr = (u8 *)ptr;
119622fb85ffSGeliang Tang 
119730f60baeSGeliang Tang 				put_unaligned_be16(port, bptr);
119822fb85ffSGeliang Tang 				bptr += 2;
119922fb85ffSGeliang Tang 				put_unaligned_be64(opts->ahmac, bptr);
120022fb85ffSGeliang Tang 				bptr += 8;
120122fb85ffSGeliang Tang 				put_unaligned_be16(TCPOPT_NOP << 8 |
120222fb85ffSGeliang Tang 						   TCPOPT_NOP, bptr);
120322fb85ffSGeliang Tang 
120422fb85ffSGeliang Tang 				ptr += 3;
120522fb85ffSGeliang Tang 			} else {
120630f60baeSGeliang Tang 				put_unaligned_be32(port << 16 |
120722fb85ffSGeliang Tang 						   TCPOPT_NOP << 8 |
120822fb85ffSGeliang Tang 						   TCPOPT_NOP, ptr);
120922fb85ffSGeliang Tang 				ptr += 1;
12103df523abSPeter Krystad 			}
121122fb85ffSGeliang Tang 		}
12123df523abSPeter Krystad 	}
12133df523abSPeter Krystad 
12143df523abSPeter Krystad 	if (OPTION_MPTCP_RM_ADDR & opts->suboptions) {
12156445e17aSGeliang Tang 		u8 i = 1;
12166445e17aSGeliang Tang 
12173df523abSPeter Krystad 		*ptr++ = mptcp_option(MPTCPOPT_RM_ADDR,
12186445e17aSGeliang Tang 				      TCPOLEN_MPTCP_RM_ADDR_BASE + opts->rm_list.nr,
12196445e17aSGeliang Tang 				      0, opts->rm_list.ids[0]);
12206445e17aSGeliang Tang 
12216445e17aSGeliang Tang 		while (i < opts->rm_list.nr) {
12226445e17aSGeliang Tang 			u8 id1, id2, id3, id4;
12236445e17aSGeliang Tang 
12246445e17aSGeliang Tang 			id1 = opts->rm_list.ids[i];
12256445e17aSGeliang Tang 			id2 = i + 1 < opts->rm_list.nr ? opts->rm_list.ids[i + 1] : TCPOPT_NOP;
12266445e17aSGeliang Tang 			id3 = i + 2 < opts->rm_list.nr ? opts->rm_list.ids[i + 2] : TCPOPT_NOP;
12276445e17aSGeliang Tang 			id4 = i + 3 < opts->rm_list.nr ? opts->rm_list.ids[i + 3] : TCPOPT_NOP;
12286445e17aSGeliang Tang 			put_unaligned_be32(id1 << 24 | id2 << 16 | id3 << 8 | id4, ptr);
12296445e17aSGeliang Tang 			ptr += 1;
12306445e17aSGeliang Tang 			i += 4;
12316445e17aSGeliang Tang 		}
12323df523abSPeter Krystad 	}
12333df523abSPeter Krystad 
123406706542SGeliang Tang 	if (OPTION_MPTCP_PRIO & opts->suboptions) {
123506706542SGeliang Tang 		const struct sock *ssk = (const struct sock *)tp;
123606706542SGeliang Tang 		struct mptcp_subflow_context *subflow;
123706706542SGeliang Tang 
123806706542SGeliang Tang 		subflow = mptcp_subflow_ctx(ssk);
123906706542SGeliang Tang 		subflow->send_mp_prio = 0;
124006706542SGeliang Tang 
124106706542SGeliang Tang 		*ptr++ = mptcp_option(MPTCPOPT_MP_PRIO,
124206706542SGeliang Tang 				      TCPOLEN_MPTCP_PRIO,
124306706542SGeliang Tang 				      opts->backup, TCPOPT_NOP);
124406706542SGeliang Tang 	}
124506706542SGeliang Tang 
1246ec3edaa7SPeter Krystad 	if (OPTION_MPTCP_MPJ_SYN & opts->suboptions) {
1247ec3edaa7SPeter Krystad 		*ptr++ = mptcp_option(MPTCPOPT_MP_JOIN,
1248ec3edaa7SPeter Krystad 				      TCPOLEN_MPTCP_MPJ_SYN,
1249ec3edaa7SPeter Krystad 				      opts->backup, opts->join_id);
1250ec3edaa7SPeter Krystad 		put_unaligned_be32(opts->token, ptr);
1251ec3edaa7SPeter Krystad 		ptr += 1;
1252ec3edaa7SPeter Krystad 		put_unaligned_be32(opts->nonce, ptr);
1253ec3edaa7SPeter Krystad 		ptr += 1;
1254ec3edaa7SPeter Krystad 	}
1255ec3edaa7SPeter Krystad 
1256f296234cSPeter Krystad 	if (OPTION_MPTCP_MPJ_SYNACK & opts->suboptions) {
1257f296234cSPeter Krystad 		*ptr++ = mptcp_option(MPTCPOPT_MP_JOIN,
1258f296234cSPeter Krystad 				      TCPOLEN_MPTCP_MPJ_SYNACK,
1259f296234cSPeter Krystad 				      opts->backup, opts->join_id);
1260f296234cSPeter Krystad 		put_unaligned_be64(opts->thmac, ptr);
1261f296234cSPeter Krystad 		ptr += 2;
1262f296234cSPeter Krystad 		put_unaligned_be32(opts->nonce, ptr);
1263f296234cSPeter Krystad 		ptr += 1;
1264f296234cSPeter Krystad 	}
1265f296234cSPeter Krystad 
1266ec3edaa7SPeter Krystad 	if (OPTION_MPTCP_MPJ_ACK & opts->suboptions) {
1267ec3edaa7SPeter Krystad 		*ptr++ = mptcp_option(MPTCPOPT_MP_JOIN,
1268ec3edaa7SPeter Krystad 				      TCPOLEN_MPTCP_MPJ_ACK, 0, 0);
1269ec3edaa7SPeter Krystad 		memcpy(ptr, opts->hmac, MPTCPOPT_HMAC_LEN);
1270ec3edaa7SPeter Krystad 		ptr += 5;
1271ec3edaa7SPeter Krystad 	}
1272ec3edaa7SPeter Krystad 
1273dc87efdbSFlorian Westphal 	if (OPTION_MPTCP_RST & opts->suboptions)
1274dc87efdbSFlorian Westphal 		*ptr++ = mptcp_option(MPTCPOPT_RST,
1275dc87efdbSFlorian Westphal 				      TCPOLEN_MPTCP_RST,
1276dc87efdbSFlorian Westphal 				      opts->reset_transient,
1277dc87efdbSFlorian Westphal 				      opts->reset_reason);
1278dc87efdbSFlorian Westphal 
12796d0060f6SMat Martineau 	if (opts->ext_copy.use_ack || opts->ext_copy.use_map) {
12806d0060f6SMat Martineau 		struct mptcp_ext *mpext = &opts->ext_copy;
12816d0060f6SMat Martineau 		u8 len = TCPOLEN_MPTCP_DSS_BASE;
12826d0060f6SMat Martineau 		u8 flags = 0;
12836d0060f6SMat Martineau 
12846d0060f6SMat Martineau 		if (mpext->use_ack) {
1285a0c1d0eaSChristoph Paasch 			flags = MPTCP_DSS_HAS_ACK;
1286a0c1d0eaSChristoph Paasch 			if (mpext->ack64) {
12876d0060f6SMat Martineau 				len += TCPOLEN_MPTCP_DSS_ACK64;
1288a0c1d0eaSChristoph Paasch 				flags |= MPTCP_DSS_ACK64;
1289a0c1d0eaSChristoph Paasch 			} else {
1290a0c1d0eaSChristoph Paasch 				len += TCPOLEN_MPTCP_DSS_ACK32;
1291a0c1d0eaSChristoph Paasch 			}
12926d0060f6SMat Martineau 		}
12936d0060f6SMat Martineau 
12946d0060f6SMat Martineau 		if (mpext->use_map) {
12956d0060f6SMat Martineau 			len += TCPOLEN_MPTCP_DSS_MAP64;
12966d0060f6SMat Martineau 
12976d0060f6SMat Martineau 			/* Use only 64-bit mapping flags for now, add
12986d0060f6SMat Martineau 			 * support for optional 32-bit mappings later.
12996d0060f6SMat Martineau 			 */
13006d0060f6SMat Martineau 			flags |= MPTCP_DSS_HAS_MAP | MPTCP_DSS_DSN64;
13016d0060f6SMat Martineau 			if (mpext->data_fin)
13026d0060f6SMat Martineau 				flags |= MPTCP_DSS_DATA_FIN;
13036d0060f6SMat Martineau 		}
13046d0060f6SMat Martineau 
13053df523abSPeter Krystad 		*ptr++ = mptcp_option(MPTCPOPT_DSS, len, 0, flags);
13066d0060f6SMat Martineau 
13076d0060f6SMat Martineau 		if (mpext->use_ack) {
1308a0c1d0eaSChristoph Paasch 			if (mpext->ack64) {
13096d0060f6SMat Martineau 				put_unaligned_be64(mpext->data_ack, ptr);
13106d0060f6SMat Martineau 				ptr += 2;
1311a0c1d0eaSChristoph Paasch 			} else {
1312a0c1d0eaSChristoph Paasch 				put_unaligned_be32(mpext->data_ack32, ptr);
1313a0c1d0eaSChristoph Paasch 				ptr += 1;
1314a0c1d0eaSChristoph Paasch 			}
13156d0060f6SMat Martineau 		}
13166d0060f6SMat Martineau 
13176d0060f6SMat Martineau 		if (mpext->use_map) {
13186d0060f6SMat Martineau 			put_unaligned_be64(mpext->data_seq, ptr);
13196d0060f6SMat Martineau 			ptr += 2;
13206d0060f6SMat Martineau 			put_unaligned_be32(mpext->subflow_seq, ptr);
13216d0060f6SMat Martineau 			ptr += 1;
13226d0060f6SMat Martineau 			put_unaligned_be32(mpext->data_len << 16 |
13236d0060f6SMat Martineau 					   TCPOPT_NOP << 8 | TCPOPT_NOP, ptr);
13246d0060f6SMat Martineau 		}
13256d0060f6SMat Martineau 	}
1326fa3fe2b1SFlorian Westphal 
1327fa3fe2b1SFlorian Westphal 	if (tp)
1328fa3fe2b1SFlorian Westphal 		mptcp_set_rwin(tp);
1329eda7acddSPeter Krystad }
1330dc87efdbSFlorian Westphal 
1331dc87efdbSFlorian Westphal __be32 mptcp_get_reset_option(const struct sk_buff *skb)
1332dc87efdbSFlorian Westphal {
1333dc87efdbSFlorian Westphal 	const struct mptcp_ext *ext = mptcp_get_ext(skb);
1334dc87efdbSFlorian Westphal 	u8 flags, reason;
1335dc87efdbSFlorian Westphal 
1336dc87efdbSFlorian Westphal 	if (ext) {
1337dc87efdbSFlorian Westphal 		flags = ext->reset_transient;
1338dc87efdbSFlorian Westphal 		reason = ext->reset_reason;
1339dc87efdbSFlorian Westphal 
1340dc87efdbSFlorian Westphal 		return mptcp_option(MPTCPOPT_RST, TCPOLEN_MPTCP_RST,
1341dc87efdbSFlorian Westphal 				    flags, reason);
1342dc87efdbSFlorian Westphal 	}
1343dc87efdbSFlorian Westphal 
1344dc87efdbSFlorian Westphal 	return htonl(0u);
1345dc87efdbSFlorian Westphal }
1346dc87efdbSFlorian Westphal EXPORT_SYMBOL_GPL(mptcp_get_reset_option);
1347