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; 29*5c4a824dSGeliang 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) 2233df523abSPeter Krystad mp_opt->family = MPTCP_ADDR_IPVERSION_4; 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) 2273df523abSPeter Krystad mp_opt->family = MPTCP_ADDR_IPVERSION_6; 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) 2343df523abSPeter Krystad mp_opt->family = MPTCP_ADDR_IPVERSION_4; 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) 2383df523abSPeter Krystad mp_opt->family = MPTCP_ADDR_IPVERSION_6; 2393df523abSPeter Krystad #endif 2403df523abSPeter Krystad else 2413df523abSPeter Krystad break; 2423df523abSPeter Krystad } 2433df523abSPeter Krystad 2443df523abSPeter Krystad mp_opt->add_addr = 1; 2453df523abSPeter Krystad mp_opt->addr_id = *ptr++; 2463df523abSPeter Krystad if (mp_opt->family == MPTCP_ADDR_IPVERSION_4) { 2473df523abSPeter Krystad memcpy((u8 *)&mp_opt->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) { 2513df523abSPeter Krystad mp_opt->port = get_unaligned_be16(ptr); 2523df523abSPeter Krystad ptr += 2; 2533df523abSPeter Krystad } 2543df523abSPeter Krystad } 2553df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6) 2563df523abSPeter Krystad else { 2573df523abSPeter Krystad memcpy(mp_opt->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) { 2613df523abSPeter Krystad mp_opt->port = 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", 27190a4aea8SGeliang Tang (mp_opt->family == MPTCP_ADDR_IPVERSION_6) ? "6" : "", 27290a4aea8SGeliang Tang mp_opt->addr_id, mp_opt->ahmac, mp_opt->echo, mp_opt->port); 2733df523abSPeter Krystad break; 2743df523abSPeter Krystad 2753df523abSPeter Krystad case MPTCPOPT_RM_ADDR: 276*5c4a824dSGeliang Tang if (opsize < TCPOLEN_MPTCP_RM_ADDR_BASE + 1 || 277*5c4a824dSGeliang 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; 283*5c4a824dSGeliang Tang mp_opt->rm_list.nr = opsize - TCPOLEN_MPTCP_RM_ADDR_BASE; 284*5c4a824dSGeliang Tang for (i = 0; i < mp_opt->rm_list.nr; i++) 285*5c4a824dSGeliang Tang mp_opt->rm_list.ids[i] = *ptr++; 286*5c4a824dSGeliang 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 308eda7acddSPeter Krystad default: 309eda7acddSPeter Krystad break; 310eda7acddSPeter Krystad } 311eda7acddSPeter Krystad } 312eda7acddSPeter Krystad 313cec37a6eSPeter Krystad void mptcp_get_options(const struct sk_buff *skb, 314cfde141eSPaolo Abeni struct mptcp_options_received *mp_opt) 315cec37a6eSPeter Krystad { 316cec37a6eSPeter Krystad const struct tcphdr *th = tcp_hdr(skb); 317cfde141eSPaolo Abeni const unsigned char *ptr; 318cfde141eSPaolo Abeni int length; 319cec37a6eSPeter Krystad 320cfde141eSPaolo Abeni /* initialize option status */ 321cfde141eSPaolo Abeni mp_opt->mp_capable = 0; 322cfde141eSPaolo Abeni mp_opt->mp_join = 0; 323cfde141eSPaolo Abeni mp_opt->add_addr = 0; 324fe2d9b1aSGeliang Tang mp_opt->ahmac = 0; 32550c504a2SFlorian Westphal mp_opt->fastclose = 0; 32665b8c8a6SGeliang Tang mp_opt->port = 0; 327cfde141eSPaolo Abeni mp_opt->rm_addr = 0; 328cfde141eSPaolo Abeni mp_opt->dss = 0; 32940453a5cSGeliang Tang mp_opt->mp_prio = 0; 330cfde141eSPaolo Abeni 331cfde141eSPaolo Abeni length = (th->doff * 4) - sizeof(struct tcphdr); 332cec37a6eSPeter Krystad ptr = (const unsigned char *)(th + 1); 333cec37a6eSPeter Krystad 334cec37a6eSPeter Krystad while (length > 0) { 335cec37a6eSPeter Krystad int opcode = *ptr++; 336cec37a6eSPeter Krystad int opsize; 337cec37a6eSPeter Krystad 338cec37a6eSPeter Krystad switch (opcode) { 339cec37a6eSPeter Krystad case TCPOPT_EOL: 340cec37a6eSPeter Krystad return; 341cec37a6eSPeter Krystad case TCPOPT_NOP: /* Ref: RFC 793 section 3.1 */ 342cec37a6eSPeter Krystad length--; 343cec37a6eSPeter Krystad continue; 344cec37a6eSPeter Krystad default: 345cec37a6eSPeter Krystad opsize = *ptr++; 346cec37a6eSPeter Krystad if (opsize < 2) /* "silly options" */ 347cec37a6eSPeter Krystad return; 348cec37a6eSPeter Krystad if (opsize > length) 349cec37a6eSPeter Krystad return; /* don't parse partial options */ 350cec37a6eSPeter Krystad if (opcode == TCPOPT_MPTCP) 351cfde141eSPaolo Abeni mptcp_parse_option(skb, ptr, opsize, mp_opt); 352cec37a6eSPeter Krystad ptr += opsize - 2; 353cec37a6eSPeter Krystad length -= opsize; 354cec37a6eSPeter Krystad } 355cec37a6eSPeter Krystad } 356cec37a6eSPeter Krystad } 357cec37a6eSPeter Krystad 358cc7972eaSChristoph Paasch bool mptcp_syn_options(struct sock *sk, const struct sk_buff *skb, 359cc7972eaSChristoph Paasch unsigned int *size, struct mptcp_out_options *opts) 360cec37a6eSPeter Krystad { 361cec37a6eSPeter Krystad struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk); 362cec37a6eSPeter Krystad 363cc7972eaSChristoph Paasch /* we will use snd_isn to detect first pkt [re]transmission 364cc7972eaSChristoph Paasch * in mptcp_established_options_mp() 365cc7972eaSChristoph Paasch */ 366cc7972eaSChristoph Paasch subflow->snd_isn = TCP_SKB_CB(skb)->end_seq; 367cec37a6eSPeter Krystad if (subflow->request_mptcp) { 368cec37a6eSPeter Krystad opts->suboptions = OPTION_MPTCP_MPC_SYN; 369cec37a6eSPeter Krystad *size = TCPOLEN_MPTCP_MPC_SYN; 370cec37a6eSPeter Krystad return true; 371ec3edaa7SPeter Krystad } else if (subflow->request_join) { 372ec3edaa7SPeter Krystad pr_debug("remote_token=%u, nonce=%u", subflow->remote_token, 373ec3edaa7SPeter Krystad subflow->local_nonce); 374ec3edaa7SPeter Krystad opts->suboptions = OPTION_MPTCP_MPJ_SYN; 375ec3edaa7SPeter Krystad opts->join_id = subflow->local_id; 376ec3edaa7SPeter Krystad opts->token = subflow->remote_token; 377ec3edaa7SPeter Krystad opts->nonce = subflow->local_nonce; 378ec3edaa7SPeter Krystad opts->backup = subflow->request_bkup; 379ec3edaa7SPeter Krystad *size = TCPOLEN_MPTCP_MPJ_SYN; 380ec3edaa7SPeter Krystad return true; 381cec37a6eSPeter Krystad } 382cec37a6eSPeter Krystad return false; 383cec37a6eSPeter Krystad } 384cec37a6eSPeter Krystad 385ec3edaa7SPeter Krystad /* MP_JOIN client subflow must wait for 4th ack before sending any data: 386ec3edaa7SPeter Krystad * TCP can't schedule delack timer before the subflow is fully established. 387ec3edaa7SPeter Krystad * MPTCP uses the delack timer to do 3rd ack retransmissions 388ec3edaa7SPeter Krystad */ 389ec3edaa7SPeter Krystad static void schedule_3rdack_retransmission(struct sock *sk) 390ec3edaa7SPeter Krystad { 391ec3edaa7SPeter Krystad struct inet_connection_sock *icsk = inet_csk(sk); 392ec3edaa7SPeter Krystad struct tcp_sock *tp = tcp_sk(sk); 393ec3edaa7SPeter Krystad unsigned long timeout; 394ec3edaa7SPeter Krystad 395ec3edaa7SPeter Krystad /* reschedule with a timeout above RTT, as we must look only for drop */ 396ec3edaa7SPeter Krystad if (tp->srtt_us) 397ec3edaa7SPeter Krystad timeout = tp->srtt_us << 1; 398ec3edaa7SPeter Krystad else 399ec3edaa7SPeter Krystad timeout = TCP_TIMEOUT_INIT; 400ec3edaa7SPeter Krystad 401ec3edaa7SPeter Krystad WARN_ON_ONCE(icsk->icsk_ack.pending & ICSK_ACK_TIMER); 402ec3edaa7SPeter Krystad icsk->icsk_ack.pending |= ICSK_ACK_SCHED | ICSK_ACK_TIMER; 403ec3edaa7SPeter Krystad icsk->icsk_ack.timeout = timeout; 404ec3edaa7SPeter Krystad sk_reset_timer(sk, &icsk->icsk_delack_timer, timeout); 405ec3edaa7SPeter Krystad } 406ec3edaa7SPeter Krystad 407ec3edaa7SPeter Krystad static void clear_3rdack_retransmission(struct sock *sk) 408ec3edaa7SPeter Krystad { 409ec3edaa7SPeter Krystad struct inet_connection_sock *icsk = inet_csk(sk); 410ec3edaa7SPeter Krystad 411ec3edaa7SPeter Krystad sk_stop_timer(sk, &icsk->icsk_delack_timer); 412ec3edaa7SPeter Krystad icsk->icsk_ack.timeout = 0; 413ec3edaa7SPeter Krystad icsk->icsk_ack.ato = 0; 414ec3edaa7SPeter Krystad icsk->icsk_ack.pending &= ~(ICSK_ACK_SCHED | ICSK_ACK_TIMER); 415ec3edaa7SPeter Krystad } 416ec3edaa7SPeter Krystad 417cc7972eaSChristoph Paasch static bool mptcp_established_options_mp(struct sock *sk, struct sk_buff *skb, 418d87903b6SPaolo Abeni bool snd_data_fin_enable, 419cc7972eaSChristoph Paasch unsigned int *size, 4206d0060f6SMat Martineau unsigned int remaining, 421cec37a6eSPeter Krystad struct mptcp_out_options *opts) 422cec37a6eSPeter Krystad { 423cec37a6eSPeter Krystad struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk); 424cc7972eaSChristoph Paasch struct mptcp_ext *mpext; 425cc7972eaSChristoph Paasch unsigned int data_len; 426cec37a6eSPeter Krystad 427ec3edaa7SPeter Krystad /* When skb is not available, we better over-estimate the emitted 428ec3edaa7SPeter Krystad * options len. A full DSS option (28 bytes) is longer than 429ec3edaa7SPeter Krystad * TCPOLEN_MPTCP_MPC_ACK_DATA(22) or TCPOLEN_MPTCP_MPJ_ACK(24), so 430ec3edaa7SPeter Krystad * tell the caller to defer the estimate to 431ec3edaa7SPeter Krystad * mptcp_established_options_dss(), which will reserve enough space. 432cc7972eaSChristoph Paasch */ 433ec3edaa7SPeter Krystad if (!skb) 434ec3edaa7SPeter Krystad return false; 435ec3edaa7SPeter Krystad 436d87903b6SPaolo Abeni /* MPC/MPJ needed only on 3rd ack packet, DATA_FIN and TCP shutdown take precedence */ 437d87903b6SPaolo Abeni if (subflow->fully_established || snd_data_fin_enable || 438d87903b6SPaolo Abeni subflow->snd_isn != TCP_SKB_CB(skb)->seq || 439d87903b6SPaolo Abeni sk->sk_state != TCP_ESTABLISHED) 440ec3edaa7SPeter Krystad return false; 441ec3edaa7SPeter Krystad 442ec3edaa7SPeter Krystad if (subflow->mp_capable) { 443cc7972eaSChristoph Paasch mpext = mptcp_get_ext(skb); 444cc7972eaSChristoph Paasch data_len = mpext ? mpext->data_len : 0; 445cc7972eaSChristoph Paasch 446cc7972eaSChristoph Paasch /* we will check ext_copy.data_len in mptcp_write_options() to 447cc7972eaSChristoph Paasch * discriminate between TCPOLEN_MPTCP_MPC_ACK_DATA and 448cc7972eaSChristoph Paasch * TCPOLEN_MPTCP_MPC_ACK 449cc7972eaSChristoph Paasch */ 450cc7972eaSChristoph Paasch opts->ext_copy.data_len = data_len; 451cec37a6eSPeter Krystad opts->suboptions = OPTION_MPTCP_MPC_ACK; 452cec37a6eSPeter Krystad opts->sndr_key = subflow->local_key; 453cec37a6eSPeter Krystad opts->rcvr_key = subflow->remote_key; 454cc7972eaSChristoph Paasch 455cc7972eaSChristoph Paasch /* Section 3.1. 456cc7972eaSChristoph Paasch * The MP_CAPABLE option is carried on the SYN, SYN/ACK, and ACK 457cc7972eaSChristoph Paasch * packets that start the first subflow of an MPTCP connection, 458cc7972eaSChristoph Paasch * as well as the first packet that carries data 459cc7972eaSChristoph Paasch */ 460cc7972eaSChristoph Paasch if (data_len > 0) 461cc7972eaSChristoph Paasch *size = ALIGN(TCPOLEN_MPTCP_MPC_ACK_DATA, 4); 462cc7972eaSChristoph Paasch else 463cec37a6eSPeter Krystad *size = TCPOLEN_MPTCP_MPC_ACK; 464cc7972eaSChristoph Paasch 465cc7972eaSChristoph Paasch pr_debug("subflow=%p, local_key=%llu, remote_key=%llu map_len=%d", 466cc7972eaSChristoph Paasch subflow, subflow->local_key, subflow->remote_key, 467cc7972eaSChristoph Paasch data_len); 468cc7972eaSChristoph Paasch 469cec37a6eSPeter Krystad return true; 470ec3edaa7SPeter Krystad } else if (subflow->mp_join) { 471ec3edaa7SPeter Krystad opts->suboptions = OPTION_MPTCP_MPJ_ACK; 472ec3edaa7SPeter Krystad memcpy(opts->hmac, subflow->hmac, MPTCPOPT_HMAC_LEN); 473ec3edaa7SPeter Krystad *size = TCPOLEN_MPTCP_MPJ_ACK; 474ec3edaa7SPeter Krystad pr_debug("subflow=%p", subflow); 475ec3edaa7SPeter Krystad 476ec3edaa7SPeter Krystad schedule_3rdack_retransmission(sk); 477ec3edaa7SPeter Krystad return true; 478cec37a6eSPeter Krystad } 479cec37a6eSPeter Krystad return false; 480cec37a6eSPeter Krystad } 481cec37a6eSPeter Krystad 4826d0060f6SMat Martineau static void mptcp_write_data_fin(struct mptcp_subflow_context *subflow, 4839c29e361SPaolo Abeni struct sk_buff *skb, struct mptcp_ext *ext) 4846d0060f6SMat Martineau { 485017512a0SPaolo Abeni /* The write_seq value has already been incremented, so the actual 486017512a0SPaolo Abeni * sequence number for the DATA_FIN is one less. 487017512a0SPaolo Abeni */ 488017512a0SPaolo Abeni u64 data_fin_tx_seq = READ_ONCE(mptcp_sk(subflow->conn)->write_seq) - 1; 4897279da61SMat Martineau 4909c29e361SPaolo Abeni if (!ext->use_map || !skb->len) { 4916d0060f6SMat Martineau /* RFC6824 requires a DSS mapping with specific values 4926d0060f6SMat Martineau * if DATA_FIN is set but no data payload is mapped 4936d0060f6SMat Martineau */ 4946d37a0b8SMat Martineau ext->data_fin = 1; 4956d0060f6SMat Martineau ext->use_map = 1; 4966d0060f6SMat Martineau ext->dsn64 = 1; 497017512a0SPaolo Abeni ext->data_seq = data_fin_tx_seq; 4986d0060f6SMat Martineau ext->subflow_seq = 0; 4996d0060f6SMat Martineau ext->data_len = 1; 5007279da61SMat Martineau } else if (ext->data_seq + ext->data_len == data_fin_tx_seq) { 5016d37a0b8SMat Martineau /* If there's an existing DSS mapping and it is the 5026d37a0b8SMat Martineau * final mapping, DATA_FIN consumes 1 additional byte of 5036d37a0b8SMat Martineau * mapping space. 5046d0060f6SMat Martineau */ 5056d37a0b8SMat Martineau ext->data_fin = 1; 5066d0060f6SMat Martineau ext->data_len++; 5076d0060f6SMat Martineau } 5086d0060f6SMat Martineau } 5096d0060f6SMat Martineau 5106d0060f6SMat Martineau static bool mptcp_established_options_dss(struct sock *sk, struct sk_buff *skb, 511d87903b6SPaolo Abeni bool snd_data_fin_enable, 5126d0060f6SMat Martineau unsigned int *size, 5136d0060f6SMat Martineau unsigned int remaining, 5146d0060f6SMat Martineau struct mptcp_out_options *opts) 5156d0060f6SMat Martineau { 5166d0060f6SMat Martineau struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk); 5177279da61SMat Martineau struct mptcp_sock *msk = mptcp_sk(subflow->conn); 5186d0060f6SMat Martineau unsigned int dss_size = 0; 5196d0060f6SMat Martineau struct mptcp_ext *mpext; 5206d0060f6SMat Martineau unsigned int ack_size; 521d22f4988SChristoph Paasch bool ret = false; 522d87903b6SPaolo Abeni u64 ack_seq; 5236d0060f6SMat Martineau 5240bac966aSMat Martineau mpext = skb ? mptcp_get_ext(skb) : NULL; 5256d0060f6SMat Martineau 5267279da61SMat Martineau if (!skb || (mpext && mpext->use_map) || snd_data_fin_enable) { 5276d0060f6SMat Martineau unsigned int map_size; 5286d0060f6SMat Martineau 5296d0060f6SMat Martineau map_size = TCPOLEN_MPTCP_DSS_BASE + TCPOLEN_MPTCP_DSS_MAP64; 5306d0060f6SMat Martineau 5316d0060f6SMat Martineau remaining -= map_size; 5326d0060f6SMat Martineau dss_size = map_size; 5336d0060f6SMat Martineau if (mpext) 5346d0060f6SMat Martineau opts->ext_copy = *mpext; 5356d0060f6SMat Martineau 5367279da61SMat Martineau if (skb && snd_data_fin_enable) 5379c29e361SPaolo Abeni mptcp_write_data_fin(subflow, skb, &opts->ext_copy); 538d22f4988SChristoph Paasch ret = true; 539d22f4988SChristoph Paasch } 540d22f4988SChristoph Paasch 5412398e399SPaolo Abeni /* passive sockets msk will set the 'can_ack' after accept(), even 5422398e399SPaolo Abeni * if the first subflow may have the already the remote key handy 5432398e399SPaolo Abeni */ 544d22f4988SChristoph Paasch opts->ext_copy.use_ack = 0; 545dc093db5SPaolo Abeni if (!READ_ONCE(msk->can_ack)) { 546d22f4988SChristoph Paasch *size = ALIGN(dss_size, 4); 547d22f4988SChristoph Paasch return ret; 5486d0060f6SMat Martineau } 5496d0060f6SMat Martineau 550e3859603SPaolo Abeni ack_seq = READ_ONCE(msk->ack_seq); 55137198e93SDavide Caratti if (READ_ONCE(msk->use_64bit_ack)) { 5526d0060f6SMat Martineau ack_size = TCPOLEN_MPTCP_DSS_ACK64; 553e3859603SPaolo Abeni opts->ext_copy.data_ack = ack_seq; 554a0c1d0eaSChristoph Paasch opts->ext_copy.ack64 = 1; 555a0c1d0eaSChristoph Paasch } else { 556a0c1d0eaSChristoph Paasch ack_size = TCPOLEN_MPTCP_DSS_ACK32; 557e3859603SPaolo Abeni opts->ext_copy.data_ack32 = (uint32_t)ack_seq; 558a0c1d0eaSChristoph Paasch opts->ext_copy.ack64 = 0; 559a0c1d0eaSChristoph Paasch } 560a0c1d0eaSChristoph Paasch opts->ext_copy.use_ack = 1; 561ea4ca586SPaolo Abeni WRITE_ONCE(msk->old_wspace, __mptcp_space((struct sock *)msk)); 5626d0060f6SMat Martineau 5636d0060f6SMat Martineau /* Add kind/length/subtype/flag overhead if mapping is not populated */ 5646d0060f6SMat Martineau if (dss_size == 0) 5656d0060f6SMat Martineau ack_size += TCPOLEN_MPTCP_DSS_BASE; 5666d0060f6SMat Martineau 5676d0060f6SMat Martineau dss_size += ack_size; 5686d0060f6SMat Martineau 5696d0060f6SMat Martineau *size = ALIGN(dss_size, 4); 5706d0060f6SMat Martineau return true; 5716d0060f6SMat Martineau } 5726d0060f6SMat Martineau 5733df523abSPeter Krystad static u64 add_addr_generate_hmac(u64 key1, u64 key2, u8 addr_id, 5743df523abSPeter Krystad struct in_addr *addr) 5753df523abSPeter Krystad { 576bd697222STodd Malsbary u8 hmac[SHA256_DIGEST_SIZE]; 5773df523abSPeter Krystad u8 msg[7]; 5783df523abSPeter Krystad 5793df523abSPeter Krystad msg[0] = addr_id; 5803df523abSPeter Krystad memcpy(&msg[1], &addr->s_addr, 4); 5813df523abSPeter Krystad msg[5] = 0; 5823df523abSPeter Krystad msg[6] = 0; 5833df523abSPeter Krystad 5843df523abSPeter Krystad mptcp_crypto_hmac_sha(key1, key2, msg, 7, hmac); 5853df523abSPeter Krystad 586bd697222STodd Malsbary return get_unaligned_be64(&hmac[SHA256_DIGEST_SIZE - sizeof(u64)]); 5873df523abSPeter Krystad } 5883df523abSPeter Krystad 5893df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6) 5903df523abSPeter Krystad static u64 add_addr6_generate_hmac(u64 key1, u64 key2, u8 addr_id, 5913df523abSPeter Krystad struct in6_addr *addr) 5923df523abSPeter Krystad { 593bd697222STodd Malsbary u8 hmac[SHA256_DIGEST_SIZE]; 5943df523abSPeter Krystad u8 msg[19]; 5953df523abSPeter Krystad 5963df523abSPeter Krystad msg[0] = addr_id; 5973df523abSPeter Krystad memcpy(&msg[1], &addr->s6_addr, 16); 5983df523abSPeter Krystad msg[17] = 0; 5993df523abSPeter Krystad msg[18] = 0; 6003df523abSPeter Krystad 6013df523abSPeter Krystad mptcp_crypto_hmac_sha(key1, key2, msg, 19, hmac); 6023df523abSPeter Krystad 603bd697222STodd Malsbary return get_unaligned_be64(&hmac[SHA256_DIGEST_SIZE - sizeof(u64)]); 6043df523abSPeter Krystad } 6053df523abSPeter Krystad #endif 6063df523abSPeter Krystad 60784dfe367SGeliang Tang static bool mptcp_established_options_add_addr(struct sock *sk, struct sk_buff *skb, 6083df523abSPeter Krystad unsigned int *size, 6093df523abSPeter Krystad unsigned int remaining, 6103df523abSPeter Krystad struct mptcp_out_options *opts) 6113df523abSPeter Krystad { 6123df523abSPeter Krystad struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk); 6133df523abSPeter Krystad struct mptcp_sock *msk = mptcp_sk(subflow->conn); 61484dfe367SGeliang Tang bool drop_other_suboptions = false; 61584dfe367SGeliang Tang unsigned int opt_size = *size; 6161b1c7a0eSPeter Krystad struct mptcp_addr_info saddr; 6176a6c05a8SGeliang Tang bool echo; 6184a2777a8SGeliang Tang bool port; 6191b1c7a0eSPeter Krystad int len; 6203df523abSPeter Krystad 621fbe0f87aSGeliang Tang if ((mptcp_pm_should_add_signal_ipv6(msk) || 622fbe0f87aSGeliang Tang mptcp_pm_should_add_signal_port(msk)) && 62384dfe367SGeliang Tang skb && skb_is_tcp_pure_ack(skb)) { 62484dfe367SGeliang Tang pr_debug("drop other suboptions"); 62584dfe367SGeliang Tang opts->suboptions = 0; 6263ae32c07SGeliang Tang opts->ext_copy.use_ack = 0; 6273ae32c07SGeliang Tang opts->ext_copy.use_map = 0; 62884dfe367SGeliang Tang remaining += opt_size; 62984dfe367SGeliang Tang drop_other_suboptions = true; 63084dfe367SGeliang Tang } 63184dfe367SGeliang Tang 632f643b803SGeliang Tang if (!mptcp_pm_should_add_signal(msk) || 6334a2777a8SGeliang Tang !(mptcp_pm_add_addr_signal(msk, remaining, &saddr, &echo, &port))) 6343df523abSPeter Krystad return false; 6351b1c7a0eSPeter Krystad 6364a2777a8SGeliang Tang len = mptcp_add_addr_len(saddr.family, echo, port); 6371b1c7a0eSPeter Krystad if (remaining < len) 6381b1c7a0eSPeter Krystad return false; 6391b1c7a0eSPeter Krystad 6401b1c7a0eSPeter Krystad *size = len; 64184dfe367SGeliang Tang if (drop_other_suboptions) 64284dfe367SGeliang Tang *size -= opt_size; 6431b1c7a0eSPeter Krystad opts->addr_id = saddr.id; 6444a2777a8SGeliang Tang if (port) 6454a2777a8SGeliang Tang opts->port = ntohs(saddr.port); 6461b1c7a0eSPeter Krystad if (saddr.family == AF_INET) { 6473df523abSPeter Krystad opts->suboptions |= OPTION_MPTCP_ADD_ADDR; 6481b1c7a0eSPeter Krystad opts->addr = saddr.addr; 6496a6c05a8SGeliang Tang if (!echo) { 6503df523abSPeter Krystad opts->ahmac = add_addr_generate_hmac(msk->local_key, 6513df523abSPeter Krystad msk->remote_key, 6523df523abSPeter Krystad opts->addr_id, 6533df523abSPeter Krystad &opts->addr); 6543df523abSPeter Krystad } 6556a6c05a8SGeliang Tang } 6563df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6) 6571b1c7a0eSPeter Krystad else if (saddr.family == AF_INET6) { 6583df523abSPeter Krystad opts->suboptions |= OPTION_MPTCP_ADD_ADDR6; 6591b1c7a0eSPeter Krystad opts->addr6 = saddr.addr6; 6606a6c05a8SGeliang Tang if (!echo) { 6613df523abSPeter Krystad opts->ahmac = add_addr6_generate_hmac(msk->local_key, 6623df523abSPeter Krystad msk->remote_key, 6633df523abSPeter Krystad opts->addr_id, 6643df523abSPeter Krystad &opts->addr6); 6653df523abSPeter Krystad } 6666a6c05a8SGeliang Tang } 6673df523abSPeter Krystad #endif 6684a2777a8SGeliang Tang pr_debug("addr_id=%d, ahmac=%llu, echo=%d, port=%d", 6694a2777a8SGeliang Tang opts->addr_id, opts->ahmac, echo, opts->port); 6703df523abSPeter Krystad 6713df523abSPeter Krystad return true; 6723df523abSPeter Krystad } 6733df523abSPeter Krystad 6745cb104aeSGeliang Tang static bool mptcp_established_options_rm_addr(struct sock *sk, 6755cb104aeSGeliang Tang unsigned int *size, 6765cb104aeSGeliang Tang unsigned int remaining, 6775cb104aeSGeliang Tang struct mptcp_out_options *opts) 6785cb104aeSGeliang Tang { 6795cb104aeSGeliang Tang struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk); 6805cb104aeSGeliang Tang struct mptcp_sock *msk = mptcp_sk(subflow->conn); 6816445e17aSGeliang Tang struct mptcp_rm_list rm_list; 6826445e17aSGeliang Tang int i, len; 6835cb104aeSGeliang Tang 6845cb104aeSGeliang Tang if (!mptcp_pm_should_rm_signal(msk) || 6856445e17aSGeliang Tang !(mptcp_pm_rm_addr_signal(msk, remaining, &rm_list))) 6865cb104aeSGeliang Tang return false; 6875cb104aeSGeliang Tang 6886445e17aSGeliang Tang len = mptcp_rm_addr_len(&rm_list); 6896445e17aSGeliang Tang if (len < 0) 6906445e17aSGeliang Tang return false; 6916445e17aSGeliang Tang if (remaining < len) 6925cb104aeSGeliang Tang return false; 6935cb104aeSGeliang Tang 6946445e17aSGeliang Tang *size = len; 6955cb104aeSGeliang Tang opts->suboptions |= OPTION_MPTCP_RM_ADDR; 6966445e17aSGeliang Tang opts->rm_list = rm_list; 6975cb104aeSGeliang Tang 6986445e17aSGeliang Tang for (i = 0; i < opts->rm_list.nr; i++) 6996445e17aSGeliang Tang pr_debug("rm_list_ids[%d]=%d", i, opts->rm_list.ids[i]); 7005cb104aeSGeliang Tang 7015cb104aeSGeliang Tang return true; 7025cb104aeSGeliang Tang } 7035cb104aeSGeliang Tang 70406706542SGeliang Tang static bool mptcp_established_options_mp_prio(struct sock *sk, 70506706542SGeliang Tang unsigned int *size, 70606706542SGeliang Tang unsigned int remaining, 70706706542SGeliang Tang struct mptcp_out_options *opts) 70806706542SGeliang Tang { 70906706542SGeliang Tang struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk); 71006706542SGeliang Tang 71106706542SGeliang Tang if (!subflow->send_mp_prio) 71206706542SGeliang Tang return false; 71306706542SGeliang Tang 714ec99a470SDavide Caratti /* account for the trailing 'nop' option */ 715ec99a470SDavide Caratti if (remaining < TCPOLEN_MPTCP_PRIO_ALIGN) 71606706542SGeliang Tang return false; 71706706542SGeliang Tang 718ec99a470SDavide Caratti *size = TCPOLEN_MPTCP_PRIO_ALIGN; 71906706542SGeliang Tang opts->suboptions |= OPTION_MPTCP_PRIO; 72006706542SGeliang Tang opts->backup = subflow->request_bkup; 72106706542SGeliang Tang 72206706542SGeliang Tang pr_debug("prio=%d", opts->backup); 72306706542SGeliang Tang 72406706542SGeliang Tang return true; 72506706542SGeliang Tang } 72606706542SGeliang Tang 7276d0060f6SMat Martineau bool mptcp_established_options(struct sock *sk, struct sk_buff *skb, 7286d0060f6SMat Martineau unsigned int *size, unsigned int remaining, 7296d0060f6SMat Martineau struct mptcp_out_options *opts) 7306d0060f6SMat Martineau { 731d87903b6SPaolo Abeni struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk); 732d87903b6SPaolo Abeni struct mptcp_sock *msk = mptcp_sk(subflow->conn); 7336d0060f6SMat Martineau unsigned int opt_size = 0; 734d87903b6SPaolo Abeni bool snd_data_fin; 7356d0060f6SMat Martineau bool ret = false; 7366d0060f6SMat Martineau 7373df523abSPeter Krystad opts->suboptions = 0; 7383df523abSPeter Krystad 739d87903b6SPaolo Abeni if (unlikely(__mptcp_check_fallback(msk))) 740e1ff9e82SDavide Caratti return false; 741e1ff9e82SDavide Caratti 742d5824847SPaolo Abeni /* prevent adding of any MPTCP related options on reset packet 743d5824847SPaolo Abeni * until we support MP_TCPRST/MP_FASTCLOSE 744d5824847SPaolo Abeni */ 745d5824847SPaolo Abeni if (unlikely(skb && TCP_SKB_CB(skb)->tcp_flags & TCPHDR_RST)) 746d5824847SPaolo Abeni return false; 747d5824847SPaolo Abeni 748d87903b6SPaolo Abeni snd_data_fin = mptcp_data_fin_enabled(msk); 749d87903b6SPaolo Abeni if (mptcp_established_options_mp(sk, skb, snd_data_fin, &opt_size, remaining, opts)) 7506d0060f6SMat Martineau ret = true; 751d87903b6SPaolo Abeni else if (mptcp_established_options_dss(sk, skb, snd_data_fin, &opt_size, remaining, opts)) 7526d0060f6SMat Martineau ret = true; 7536d0060f6SMat Martineau 7546d0060f6SMat Martineau /* we reserved enough space for the above options, and exceeding the 7556d0060f6SMat Martineau * TCP option space would be fatal 7566d0060f6SMat Martineau */ 7576d0060f6SMat Martineau if (WARN_ON_ONCE(opt_size > remaining)) 7586d0060f6SMat Martineau return false; 7596d0060f6SMat Martineau 7606d0060f6SMat Martineau *size += opt_size; 7616d0060f6SMat Martineau remaining -= opt_size; 76284dfe367SGeliang Tang if (mptcp_established_options_add_addr(sk, skb, &opt_size, remaining, opts)) { 7633df523abSPeter Krystad *size += opt_size; 7643df523abSPeter Krystad remaining -= opt_size; 7653df523abSPeter Krystad ret = true; 7665cb104aeSGeliang Tang } else if (mptcp_established_options_rm_addr(sk, &opt_size, remaining, opts)) { 7675cb104aeSGeliang Tang *size += opt_size; 7685cb104aeSGeliang Tang remaining -= opt_size; 7695cb104aeSGeliang Tang ret = true; 7703df523abSPeter Krystad } 7716d0060f6SMat Martineau 77206706542SGeliang Tang if (mptcp_established_options_mp_prio(sk, &opt_size, remaining, opts)) { 77306706542SGeliang Tang *size += opt_size; 77406706542SGeliang Tang remaining -= opt_size; 77506706542SGeliang Tang ret = true; 77606706542SGeliang Tang } 77706706542SGeliang Tang 7786d0060f6SMat Martineau return ret; 7796d0060f6SMat Martineau } 7806d0060f6SMat Martineau 781cec37a6eSPeter Krystad bool mptcp_synack_options(const struct request_sock *req, unsigned int *size, 782cec37a6eSPeter Krystad struct mptcp_out_options *opts) 783cec37a6eSPeter Krystad { 784cec37a6eSPeter Krystad struct mptcp_subflow_request_sock *subflow_req = mptcp_subflow_rsk(req); 785cec37a6eSPeter Krystad 786cec37a6eSPeter Krystad if (subflow_req->mp_capable) { 787cec37a6eSPeter Krystad opts->suboptions = OPTION_MPTCP_MPC_SYNACK; 788cec37a6eSPeter Krystad opts->sndr_key = subflow_req->local_key; 789cec37a6eSPeter Krystad *size = TCPOLEN_MPTCP_MPC_SYNACK; 790cec37a6eSPeter Krystad pr_debug("subflow_req=%p, local_key=%llu", 791cec37a6eSPeter Krystad subflow_req, subflow_req->local_key); 792cec37a6eSPeter Krystad return true; 793f296234cSPeter Krystad } else if (subflow_req->mp_join) { 794f296234cSPeter Krystad opts->suboptions = OPTION_MPTCP_MPJ_SYNACK; 795f296234cSPeter Krystad opts->backup = subflow_req->backup; 796f296234cSPeter Krystad opts->join_id = subflow_req->local_id; 797f296234cSPeter Krystad opts->thmac = subflow_req->thmac; 798f296234cSPeter Krystad opts->nonce = subflow_req->local_nonce; 799f296234cSPeter Krystad pr_debug("req=%p, bkup=%u, id=%u, thmac=%llu, nonce=%u", 800f296234cSPeter Krystad subflow_req, opts->backup, opts->join_id, 801f296234cSPeter Krystad opts->thmac, opts->nonce); 802f296234cSPeter Krystad *size = TCPOLEN_MPTCP_MPJ_SYNACK; 803f296234cSPeter Krystad return true; 804cec37a6eSPeter Krystad } 805cec37a6eSPeter Krystad return false; 806cec37a6eSPeter Krystad } 807cec37a6eSPeter Krystad 808d5824847SPaolo Abeni static bool check_fully_established(struct mptcp_sock *msk, struct sock *ssk, 809f296234cSPeter Krystad struct mptcp_subflow_context *subflow, 810d22f4988SChristoph Paasch struct sk_buff *skb, 811d22f4988SChristoph Paasch struct mptcp_options_received *mp_opt) 812d22f4988SChristoph Paasch { 813d22f4988SChristoph Paasch /* here we can process OoO, in-window pkts, only in-sequence 4th ack 814f296234cSPeter Krystad * will make the subflow fully established 815d22f4988SChristoph Paasch */ 816f296234cSPeter Krystad if (likely(subflow->fully_established)) { 817f296234cSPeter Krystad /* on passive sockets, check for 3rd ack retransmission 818f296234cSPeter Krystad * note that msk is always set by subflow_syn_recv_sock() 819f296234cSPeter Krystad * for mp_join subflows 820f296234cSPeter Krystad */ 821f296234cSPeter Krystad if (TCP_SKB_CB(skb)->seq == subflow->ssn_offset + 1 && 822f296234cSPeter Krystad TCP_SKB_CB(skb)->end_seq == TCP_SKB_CB(skb)->seq && 823f296234cSPeter Krystad subflow->mp_join && mp_opt->mp_join && 824f296234cSPeter Krystad READ_ONCE(msk->pm.server_side)) 825d5824847SPaolo Abeni tcp_send_ack(ssk); 826f296234cSPeter Krystad goto fully_established; 827f296234cSPeter Krystad } 828d22f4988SChristoph Paasch 829d5824847SPaolo Abeni /* we must process OoO packets before the first subflow is fully 830d5824847SPaolo Abeni * established. OoO packets are instead a protocol violation 831d5824847SPaolo Abeni * for MP_JOIN subflows as the peer must not send any data 832d5824847SPaolo Abeni * before receiving the forth ack - cfr. RFC 8684 section 3.2. 833f296234cSPeter Krystad */ 834d5824847SPaolo Abeni if (TCP_SKB_CB(skb)->seq != subflow->ssn_offset + 1) { 835d5824847SPaolo Abeni if (subflow->mp_join) 836d5824847SPaolo Abeni goto reset; 837f296234cSPeter Krystad return subflow->mp_capable; 838d5824847SPaolo Abeni } 839f296234cSPeter Krystad 8405a91e32bSPaolo Abeni if (mp_opt->dss && mp_opt->use_ack) { 841f296234cSPeter Krystad /* subflows are fully established as soon as we get any 842f296234cSPeter Krystad * additional ack. 843f296234cSPeter Krystad */ 8440be534f5SPaolo Abeni subflow->fully_established = 1; 845b93df08cSPaolo Abeni WRITE_ONCE(msk->fully_established, true); 846f296234cSPeter Krystad goto fully_established; 847f296234cSPeter Krystad } 848d22f4988SChristoph Paasch 84984dfe367SGeliang Tang if (mp_opt->add_addr) { 85084dfe367SGeliang Tang WRITE_ONCE(msk->fully_established, true); 85184dfe367SGeliang Tang return true; 85284dfe367SGeliang Tang } 85384dfe367SGeliang Tang 854d22f4988SChristoph Paasch /* If the first established packet does not contain MP_CAPABLE + data 855d5824847SPaolo Abeni * then fallback to TCP. Fallback scenarios requires a reset for 856d5824847SPaolo Abeni * MP_JOIN subflows. 857d22f4988SChristoph Paasch */ 858d22f4988SChristoph Paasch if (!mp_opt->mp_capable) { 859d5824847SPaolo Abeni if (subflow->mp_join) 860d5824847SPaolo Abeni goto reset; 861d22f4988SChristoph Paasch subflow->mp_capable = 0; 862e1ff9e82SDavide Caratti pr_fallback(msk); 863e1ff9e82SDavide Caratti __mptcp_do_fallback(msk); 864d22f4988SChristoph Paasch return false; 865d22f4988SChristoph Paasch } 866f296234cSPeter Krystad 867d6085fe1SPaolo Abeni if (unlikely(!READ_ONCE(msk->pm.server_side))) 868d6085fe1SPaolo Abeni pr_warn_once("bogus mpc option on established client sk"); 869b93df08cSPaolo Abeni mptcp_subflow_fully_established(subflow, mp_opt); 870f296234cSPeter Krystad 871f296234cSPeter Krystad fully_established: 8725b950ff4SPaolo Abeni /* if the subflow is not already linked into the conn_list, we can't 8735b950ff4SPaolo Abeni * notify the PM: this subflow is still on the listener queue 8745b950ff4SPaolo Abeni * and the PM possibly acquiring the subflow lock could race with 8755b950ff4SPaolo Abeni * the listener close 8765b950ff4SPaolo Abeni */ 8775b950ff4SPaolo Abeni if (likely(subflow->pm_notified) || list_empty(&subflow->node)) 878f296234cSPeter Krystad return true; 879f296234cSPeter Krystad 880f296234cSPeter Krystad subflow->pm_notified = 1; 881ec3edaa7SPeter Krystad if (subflow->mp_join) { 882d5824847SPaolo Abeni clear_3rdack_retransmission(ssk); 883f296234cSPeter Krystad mptcp_pm_subflow_established(msk, subflow); 884ec3edaa7SPeter Krystad } else { 8856c714f1bSFlorian Westphal mptcp_pm_fully_established(msk, ssk, GFP_ATOMIC); 886ec3edaa7SPeter Krystad } 887d22f4988SChristoph Paasch return true; 888d5824847SPaolo Abeni 889d5824847SPaolo Abeni reset: 890d5824847SPaolo Abeni mptcp_subflow_reset(ssk); 891d5824847SPaolo Abeni return false; 892d22f4988SChristoph Paasch } 893d22f4988SChristoph Paasch 894cc9d2566SPaolo Abeni static u64 expand_ack(u64 old_ack, u64 cur_ack, bool use_64bit) 895cc9d2566SPaolo Abeni { 896cc9d2566SPaolo Abeni u32 old_ack32, cur_ack32; 897cc9d2566SPaolo Abeni 898cc9d2566SPaolo Abeni if (use_64bit) 899cc9d2566SPaolo Abeni return cur_ack; 900cc9d2566SPaolo Abeni 901cc9d2566SPaolo Abeni old_ack32 = (u32)old_ack; 902cc9d2566SPaolo Abeni cur_ack32 = (u32)cur_ack; 903cc9d2566SPaolo Abeni cur_ack = (old_ack & GENMASK_ULL(63, 32)) + cur_ack32; 904cc9d2566SPaolo Abeni if (unlikely(before(cur_ack32, old_ack32))) 905cc9d2566SPaolo Abeni return cur_ack + (1LL << 32); 906cc9d2566SPaolo Abeni return cur_ack; 907cc9d2566SPaolo Abeni } 908cc9d2566SPaolo Abeni 9096f8a612aSFlorian Westphal static void ack_update_msk(struct mptcp_sock *msk, 9106e628cd3SPaolo Abeni struct sock *ssk, 911cc9d2566SPaolo Abeni struct mptcp_options_received *mp_opt) 912cc9d2566SPaolo Abeni { 9137439d687SPaolo Abeni u64 new_wnd_end, new_snd_una, snd_nxt = READ_ONCE(msk->snd_nxt); 9146f8a612aSFlorian Westphal struct sock *sk = (struct sock *)msk; 9157439d687SPaolo Abeni u64 old_snd_una; 9167439d687SPaolo Abeni 9177439d687SPaolo Abeni mptcp_data_lock(sk); 918cc9d2566SPaolo Abeni 919cc9d2566SPaolo Abeni /* avoid ack expansion on update conflict, to reduce the risk of 920cc9d2566SPaolo Abeni * wrongly expanding to a future ack sequence number, which is way 921cc9d2566SPaolo Abeni * more dangerous than missing an ack 922cc9d2566SPaolo Abeni */ 9237439d687SPaolo Abeni old_snd_una = msk->snd_una; 924cc9d2566SPaolo Abeni new_snd_una = expand_ack(old_snd_una, mp_opt->data_ack, mp_opt->ack64); 925cc9d2566SPaolo Abeni 926cc9d2566SPaolo Abeni /* ACK for data not even sent yet? Ignore. */ 927eaa2ffabSPaolo Abeni if (after64(new_snd_una, snd_nxt)) 928cc9d2566SPaolo Abeni new_snd_una = old_snd_una; 929cc9d2566SPaolo Abeni 9306f8a612aSFlorian Westphal new_wnd_end = new_snd_una + tcp_sk(ssk)->snd_wnd; 9316f8a612aSFlorian Westphal 932219d0499SPaolo Abeni if (after64(new_wnd_end, msk->wnd_end)) 9337439d687SPaolo Abeni msk->wnd_end = new_wnd_end; 934219d0499SPaolo Abeni 935219d0499SPaolo Abeni /* this assumes mptcp_incoming_options() is invoked after tcp_ack() */ 936d09d818eSPaolo Abeni if (after64(msk->wnd_end, READ_ONCE(msk->snd_nxt))) 937219d0499SPaolo Abeni __mptcp_check_push(sk, ssk); 9386f8a612aSFlorian Westphal 9397439d687SPaolo Abeni if (after64(new_snd_una, old_snd_una)) { 9407439d687SPaolo Abeni msk->snd_una = new_snd_una; 9417439d687SPaolo Abeni __mptcp_data_acked(sk); 942cc9d2566SPaolo Abeni } 9437439d687SPaolo Abeni mptcp_data_unlock(sk); 944b51f9b80SPaolo Abeni } 945cc9d2566SPaolo Abeni 9461a49b2c2SMat Martineau bool mptcp_update_rcv_data_fin(struct mptcp_sock *msk, u64 data_fin_seq, bool use_64bit) 9473721b9b6SMat Martineau { 9483721b9b6SMat Martineau /* Skip if DATA_FIN was already received. 9493721b9b6SMat Martineau * If updating simultaneously with the recvmsg loop, values 9503721b9b6SMat Martineau * should match. If they mismatch, the peer is misbehaving and 9513721b9b6SMat Martineau * we will prefer the most recent information. 9523721b9b6SMat Martineau */ 9533721b9b6SMat Martineau if (READ_ONCE(msk->rcv_data_fin) || !READ_ONCE(msk->first)) 9543721b9b6SMat Martineau return false; 9553721b9b6SMat Martineau 9561a49b2c2SMat Martineau WRITE_ONCE(msk->rcv_data_fin_seq, 9571a49b2c2SMat Martineau expand_ack(READ_ONCE(msk->ack_seq), data_fin_seq, use_64bit)); 9583721b9b6SMat Martineau WRITE_ONCE(msk->rcv_data_fin, 1); 9593721b9b6SMat Martineau 9603721b9b6SMat Martineau return true; 9613721b9b6SMat Martineau } 9623721b9b6SMat Martineau 9631b1c7a0eSPeter Krystad static bool add_addr_hmac_valid(struct mptcp_sock *msk, 9641b1c7a0eSPeter Krystad struct mptcp_options_received *mp_opt) 9651b1c7a0eSPeter Krystad { 9661b1c7a0eSPeter Krystad u64 hmac = 0; 9671b1c7a0eSPeter Krystad 9681b1c7a0eSPeter Krystad if (mp_opt->echo) 9691b1c7a0eSPeter Krystad return true; 9701b1c7a0eSPeter Krystad 9711b1c7a0eSPeter Krystad if (mp_opt->family == MPTCP_ADDR_IPVERSION_4) 9721b1c7a0eSPeter Krystad hmac = add_addr_generate_hmac(msk->remote_key, 9731b1c7a0eSPeter Krystad msk->local_key, 9741b1c7a0eSPeter Krystad mp_opt->addr_id, &mp_opt->addr); 9751b1c7a0eSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6) 9761b1c7a0eSPeter Krystad else 9771b1c7a0eSPeter Krystad hmac = add_addr6_generate_hmac(msk->remote_key, 9781b1c7a0eSPeter Krystad msk->local_key, 9791b1c7a0eSPeter Krystad mp_opt->addr_id, &mp_opt->addr6); 9801b1c7a0eSPeter Krystad #endif 9811b1c7a0eSPeter Krystad 9821b1c7a0eSPeter Krystad pr_debug("msk=%p, ahmac=%llu, mp_opt->ahmac=%llu\n", 9831b1c7a0eSPeter Krystad msk, (unsigned long long)hmac, 9841b1c7a0eSPeter Krystad (unsigned long long)mp_opt->ahmac); 9851b1c7a0eSPeter Krystad 9861b1c7a0eSPeter Krystad return hmac == mp_opt->ahmac; 9871b1c7a0eSPeter Krystad } 9881b1c7a0eSPeter Krystad 98977d0cab9SFlorian Westphal void mptcp_incoming_options(struct sock *sk, struct sk_buff *skb) 990648ef4b8SMat Martineau { 991d22f4988SChristoph Paasch struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk); 9921b1c7a0eSPeter Krystad struct mptcp_sock *msk = mptcp_sk(subflow->conn); 993cfde141eSPaolo Abeni struct mptcp_options_received mp_opt; 994648ef4b8SMat Martineau struct mptcp_ext *mpext; 995648ef4b8SMat Martineau 9966e628cd3SPaolo Abeni if (__mptcp_check_fallback(msk)) { 9976e628cd3SPaolo Abeni /* Keep it simple and unconditionally trigger send data cleanup and 9986e628cd3SPaolo Abeni * pending queue spooling. We will need to acquire the data lock 9996e628cd3SPaolo Abeni * for more accurate checks, and once the lock is acquired, such 10006e628cd3SPaolo Abeni * helpers are cheap. 10016e628cd3SPaolo Abeni */ 10026e628cd3SPaolo Abeni mptcp_data_lock(subflow->conn); 1003219d0499SPaolo Abeni if (sk_stream_memory_free(sk)) 1004219d0499SPaolo Abeni __mptcp_check_push(subflow->conn, sk); 10056e628cd3SPaolo Abeni __mptcp_data_acked(subflow->conn); 10066e628cd3SPaolo Abeni mptcp_data_unlock(subflow->conn); 1007e1ff9e82SDavide Caratti return; 10086e628cd3SPaolo Abeni } 1009e1ff9e82SDavide Caratti 1010cfde141eSPaolo Abeni mptcp_get_options(skb, &mp_opt); 1011cfde141eSPaolo Abeni if (!check_fully_established(msk, sk, subflow, skb, &mp_opt)) 1012d22f4988SChristoph Paasch return; 1013648ef4b8SMat Martineau 101450c504a2SFlorian Westphal if (mp_opt.fastclose && 101550c504a2SFlorian Westphal msk->local_key == mp_opt.rcvr_key) { 101650c504a2SFlorian Westphal WRITE_ONCE(msk->rcv_fastclose, true); 101750c504a2SFlorian Westphal mptcp_schedule_work((struct sock *)msk); 101850c504a2SFlorian Westphal } 101950c504a2SFlorian Westphal 1020cfde141eSPaolo Abeni if (mp_opt.add_addr && add_addr_hmac_valid(msk, &mp_opt)) { 10211b1c7a0eSPeter Krystad struct mptcp_addr_info addr; 10221b1c7a0eSPeter Krystad 1023cfde141eSPaolo Abeni addr.port = htons(mp_opt.port); 1024cfde141eSPaolo Abeni addr.id = mp_opt.addr_id; 1025cfde141eSPaolo Abeni if (mp_opt.family == MPTCP_ADDR_IPVERSION_4) { 10261b1c7a0eSPeter Krystad addr.family = AF_INET; 1027cfde141eSPaolo Abeni addr.addr = mp_opt.addr; 10281b1c7a0eSPeter Krystad } 10291b1c7a0eSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6) 1030cfde141eSPaolo Abeni else if (mp_opt.family == MPTCP_ADDR_IPVERSION_6) { 10311b1c7a0eSPeter Krystad addr.family = AF_INET6; 1032cfde141eSPaolo Abeni addr.addr6 = mp_opt.addr6; 10331b1c7a0eSPeter Krystad } 10341b1c7a0eSPeter Krystad #endif 1035a877de06SGeliang Tang if (!mp_opt.echo) { 10361b1c7a0eSPeter Krystad mptcp_pm_add_addr_received(msk, &addr); 1037a877de06SGeliang Tang MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_ADDADDR); 1038a877de06SGeliang Tang } else { 103900cfd77bSGeliang Tang mptcp_pm_del_add_timer(msk, &addr); 1040a877de06SGeliang Tang MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_ECHOADD); 1041a877de06SGeliang Tang } 10422fbdd9eaSGeliang Tang 10432fbdd9eaSGeliang Tang if (mp_opt.port) 10442fbdd9eaSGeliang Tang MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_PORTADD); 10452fbdd9eaSGeliang Tang 1046cfde141eSPaolo Abeni mp_opt.add_addr = 0; 10471b1c7a0eSPeter Krystad } 10481b1c7a0eSPeter Krystad 1049d0876b22SGeliang Tang if (mp_opt.rm_addr) { 1050*5c4a824dSGeliang Tang mptcp_pm_rm_addr_received(msk, &mp_opt.rm_list); 1051d0876b22SGeliang Tang mp_opt.rm_addr = 0; 1052d0876b22SGeliang Tang } 1053d0876b22SGeliang Tang 105440453a5cSGeliang Tang if (mp_opt.mp_prio) { 105540453a5cSGeliang Tang mptcp_pm_mp_prio_received(sk, mp_opt.backup); 10560be2ac28SGeliang Tang MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_MPPRIORX); 105740453a5cSGeliang Tang mp_opt.mp_prio = 0; 105840453a5cSGeliang Tang } 105940453a5cSGeliang Tang 1060cfde141eSPaolo Abeni if (!mp_opt.dss) 1061648ef4b8SMat Martineau return; 1062648ef4b8SMat Martineau 1063cc9d2566SPaolo Abeni /* we can't wait for recvmsg() to update the ack_seq, otherwise 1064cc9d2566SPaolo Abeni * monodirectional flows will stuck 1065cc9d2566SPaolo Abeni */ 1066cfde141eSPaolo Abeni if (mp_opt.use_ack) 10676f8a612aSFlorian Westphal ack_update_msk(msk, sk, &mp_opt); 1068cc9d2566SPaolo Abeni 106906827b34SMat Martineau /* Zero-data-length packets are dropped by the caller and not 107006827b34SMat Martineau * propagated to the MPTCP layer, so the skb extension does not 107106827b34SMat Martineau * need to be allocated or populated. DATA_FIN information, if 107206827b34SMat Martineau * present, needs to be updated here before the skb is freed. 107343b54c6eSMat Martineau */ 107443b54c6eSMat Martineau if (TCP_SKB_CB(skb)->seq == TCP_SKB_CB(skb)->end_seq) { 107543b54c6eSMat Martineau if (mp_opt.data_fin && mp_opt.data_len == 1 && 10761a49b2c2SMat Martineau mptcp_update_rcv_data_fin(msk, mp_opt.data_seq, mp_opt.dsn64) && 107743b54c6eSMat Martineau schedule_work(&msk->work)) 107843b54c6eSMat Martineau sock_hold(subflow->conn); 107906827b34SMat Martineau 108006827b34SMat Martineau return; 108143b54c6eSMat Martineau } 108243b54c6eSMat Martineau 1083648ef4b8SMat Martineau mpext = skb_ext_add(skb, SKB_EXT_MPTCP); 1084648ef4b8SMat Martineau if (!mpext) 1085648ef4b8SMat Martineau return; 1086648ef4b8SMat Martineau 1087648ef4b8SMat Martineau memset(mpext, 0, sizeof(*mpext)); 1088648ef4b8SMat Martineau 1089cfde141eSPaolo Abeni if (mp_opt.use_map) { 1090cfde141eSPaolo Abeni if (mp_opt.mpc_map) { 1091cc7972eaSChristoph Paasch /* this is an MP_CAPABLE carrying MPTCP data 1092cc7972eaSChristoph Paasch * we know this map the first chunk of data 1093cc7972eaSChristoph Paasch */ 1094cc7972eaSChristoph Paasch mptcp_crypto_key_sha(subflow->remote_key, NULL, 1095cc7972eaSChristoph Paasch &mpext->data_seq); 1096cc7972eaSChristoph Paasch mpext->data_seq++; 1097cc7972eaSChristoph Paasch mpext->subflow_seq = 1; 1098cc7972eaSChristoph Paasch mpext->dsn64 = 1; 1099cc7972eaSChristoph Paasch mpext->mpc_map = 1; 1100a77895dbSPaolo Abeni mpext->data_fin = 0; 1101cc7972eaSChristoph Paasch } else { 1102cfde141eSPaolo Abeni mpext->data_seq = mp_opt.data_seq; 1103cfde141eSPaolo Abeni mpext->subflow_seq = mp_opt.subflow_seq; 1104cfde141eSPaolo Abeni mpext->dsn64 = mp_opt.dsn64; 1105cfde141eSPaolo Abeni mpext->data_fin = mp_opt.data_fin; 1106cc7972eaSChristoph Paasch } 1107cfde141eSPaolo Abeni mpext->data_len = mp_opt.data_len; 1108648ef4b8SMat Martineau mpext->use_map = 1; 1109648ef4b8SMat Martineau } 1110648ef4b8SMat Martineau } 1111648ef4b8SMat Martineau 1112fa3fe2b1SFlorian Westphal static void mptcp_set_rwin(const struct tcp_sock *tp) 1113fa3fe2b1SFlorian Westphal { 1114fa3fe2b1SFlorian Westphal const struct sock *ssk = (const struct sock *)tp; 1115fa3fe2b1SFlorian Westphal const struct mptcp_subflow_context *subflow; 1116fa3fe2b1SFlorian Westphal struct mptcp_sock *msk; 1117fa3fe2b1SFlorian Westphal u64 ack_seq; 1118fa3fe2b1SFlorian Westphal 1119fa3fe2b1SFlorian Westphal subflow = mptcp_subflow_ctx(ssk); 1120fa3fe2b1SFlorian Westphal msk = mptcp_sk(subflow->conn); 1121fa3fe2b1SFlorian Westphal 1122fa3fe2b1SFlorian Westphal ack_seq = READ_ONCE(msk->ack_seq) + tp->rcv_wnd; 1123fa3fe2b1SFlorian Westphal 1124fa3fe2b1SFlorian Westphal if (after64(ack_seq, READ_ONCE(msk->rcv_wnd_sent))) 1125fa3fe2b1SFlorian Westphal WRITE_ONCE(msk->rcv_wnd_sent, ack_seq); 1126fa3fe2b1SFlorian Westphal } 1127fa3fe2b1SFlorian Westphal 1128fa3fe2b1SFlorian Westphal void mptcp_write_options(__be32 *ptr, const struct tcp_sock *tp, 1129fa3fe2b1SFlorian Westphal struct mptcp_out_options *opts) 1130eda7acddSPeter Krystad { 1131cc7972eaSChristoph Paasch if ((OPTION_MPTCP_MPC_SYN | OPTION_MPTCP_MPC_SYNACK | 1132eda7acddSPeter Krystad OPTION_MPTCP_MPC_ACK) & opts->suboptions) { 1133eda7acddSPeter Krystad u8 len; 1134eda7acddSPeter Krystad 1135eda7acddSPeter Krystad if (OPTION_MPTCP_MPC_SYN & opts->suboptions) 1136eda7acddSPeter Krystad len = TCPOLEN_MPTCP_MPC_SYN; 1137cec37a6eSPeter Krystad else if (OPTION_MPTCP_MPC_SYNACK & opts->suboptions) 1138cec37a6eSPeter Krystad len = TCPOLEN_MPTCP_MPC_SYNACK; 1139cc7972eaSChristoph Paasch else if (opts->ext_copy.data_len) 1140cc7972eaSChristoph Paasch len = TCPOLEN_MPTCP_MPC_ACK_DATA; 1141eda7acddSPeter Krystad else 1142eda7acddSPeter Krystad len = TCPOLEN_MPTCP_MPC_ACK; 1143eda7acddSPeter Krystad 11443df523abSPeter Krystad *ptr++ = mptcp_option(MPTCPOPT_MP_CAPABLE, len, 11453df523abSPeter Krystad MPTCP_SUPPORTED_VERSION, 114665492c5aSPaolo Abeni MPTCP_CAP_HMAC_SHA256); 1147cc7972eaSChristoph Paasch 1148cc7972eaSChristoph Paasch if (!((OPTION_MPTCP_MPC_SYNACK | OPTION_MPTCP_MPC_ACK) & 1149cc7972eaSChristoph Paasch opts->suboptions)) 1150cc7972eaSChristoph Paasch goto mp_capable_done; 1151cc7972eaSChristoph Paasch 1152eda7acddSPeter Krystad put_unaligned_be64(opts->sndr_key, ptr); 1153eda7acddSPeter Krystad ptr += 2; 1154cc7972eaSChristoph Paasch if (!((OPTION_MPTCP_MPC_ACK) & opts->suboptions)) 1155cc7972eaSChristoph Paasch goto mp_capable_done; 1156cc7972eaSChristoph Paasch 1157eda7acddSPeter Krystad put_unaligned_be64(opts->rcvr_key, ptr); 1158eda7acddSPeter Krystad ptr += 2; 1159cc7972eaSChristoph Paasch if (!opts->ext_copy.data_len) 1160cc7972eaSChristoph Paasch goto mp_capable_done; 1161cc7972eaSChristoph Paasch 1162cc7972eaSChristoph Paasch put_unaligned_be32(opts->ext_copy.data_len << 16 | 1163cc7972eaSChristoph Paasch TCPOPT_NOP << 8 | TCPOPT_NOP, ptr); 1164cc7972eaSChristoph Paasch ptr += 1; 1165eda7acddSPeter Krystad } 11666d0060f6SMat Martineau 1167cc7972eaSChristoph Paasch mp_capable_done: 1168e1ef6832SGeliang Tang if ((OPTION_MPTCP_ADD_ADDR 1169e1ef6832SGeliang Tang #if IS_ENABLED(CONFIG_MPTCP_IPV6) 1170e1ef6832SGeliang Tang | OPTION_MPTCP_ADD_ADDR6 1171e1ef6832SGeliang Tang #endif 1172e1ef6832SGeliang Tang ) & opts->suboptions) { 11736eb3d1e3SGeliang Tang u8 len = TCPOLEN_MPTCP_ADD_ADDR_BASE; 11746eb3d1e3SGeliang Tang u8 echo = MPTCP_ADDR_ECHO; 11753df523abSPeter Krystad 11763df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6) 1177e1ef6832SGeliang Tang if (OPTION_MPTCP_ADD_ADDR6 & opts->suboptions) 1178e1ef6832SGeliang Tang len = TCPOLEN_MPTCP_ADD_ADDR6_BASE; 1179e1ef6832SGeliang Tang #endif 1180e1ef6832SGeliang Tang 118122fb85ffSGeliang Tang if (opts->port) 118222fb85ffSGeliang Tang len += TCPOLEN_MPTCP_PORT_LEN; 118322fb85ffSGeliang Tang 11846eb3d1e3SGeliang Tang if (opts->ahmac) { 11856eb3d1e3SGeliang Tang len += sizeof(opts->ahmac); 11866eb3d1e3SGeliang Tang echo = 0; 11876eb3d1e3SGeliang Tang } 11886eb3d1e3SGeliang Tang 11893df523abSPeter Krystad *ptr++ = mptcp_option(MPTCPOPT_ADD_ADDR, 11906eb3d1e3SGeliang Tang len, echo, opts->addr_id); 1191e1ef6832SGeliang Tang if (OPTION_MPTCP_ADD_ADDR & opts->suboptions) { 11923df523abSPeter Krystad memcpy((u8 *)ptr, (u8 *)&opts->addr.s_addr, 4); 11933df523abSPeter Krystad ptr += 1; 11943df523abSPeter Krystad } 11953df523abSPeter Krystad #if IS_ENABLED(CONFIG_MPTCP_IPV6) 1196e1ef6832SGeliang Tang else if (OPTION_MPTCP_ADD_ADDR6 & opts->suboptions) { 11973df523abSPeter Krystad memcpy((u8 *)ptr, opts->addr6.s6_addr, 16); 11983df523abSPeter Krystad ptr += 4; 1199e1ef6832SGeliang Tang } 1200e1ef6832SGeliang Tang #endif 120122fb85ffSGeliang Tang 120222fb85ffSGeliang Tang if (!opts->port) { 12033df523abSPeter Krystad if (opts->ahmac) { 12043df523abSPeter Krystad put_unaligned_be64(opts->ahmac, ptr); 12053df523abSPeter Krystad ptr += 2; 12063df523abSPeter Krystad } 120722fb85ffSGeliang Tang } else { 120822fb85ffSGeliang Tang if (opts->ahmac) { 120922fb85ffSGeliang Tang u8 *bptr = (u8 *)ptr; 121022fb85ffSGeliang Tang 121122fb85ffSGeliang Tang put_unaligned_be16(opts->port, bptr); 121222fb85ffSGeliang Tang bptr += 2; 121322fb85ffSGeliang Tang put_unaligned_be64(opts->ahmac, bptr); 121422fb85ffSGeliang Tang bptr += 8; 121522fb85ffSGeliang Tang put_unaligned_be16(TCPOPT_NOP << 8 | 121622fb85ffSGeliang Tang TCPOPT_NOP, bptr); 121722fb85ffSGeliang Tang 121822fb85ffSGeliang Tang ptr += 3; 121922fb85ffSGeliang Tang } else { 122022fb85ffSGeliang Tang put_unaligned_be32(opts->port << 16 | 122122fb85ffSGeliang Tang TCPOPT_NOP << 8 | 122222fb85ffSGeliang Tang TCPOPT_NOP, ptr); 122322fb85ffSGeliang Tang ptr += 1; 12243df523abSPeter Krystad } 122522fb85ffSGeliang Tang } 12263df523abSPeter Krystad } 12273df523abSPeter Krystad 12283df523abSPeter Krystad if (OPTION_MPTCP_RM_ADDR & opts->suboptions) { 12296445e17aSGeliang Tang u8 i = 1; 12306445e17aSGeliang Tang 12313df523abSPeter Krystad *ptr++ = mptcp_option(MPTCPOPT_RM_ADDR, 12326445e17aSGeliang Tang TCPOLEN_MPTCP_RM_ADDR_BASE + opts->rm_list.nr, 12336445e17aSGeliang Tang 0, opts->rm_list.ids[0]); 12346445e17aSGeliang Tang 12356445e17aSGeliang Tang while (i < opts->rm_list.nr) { 12366445e17aSGeliang Tang u8 id1, id2, id3, id4; 12376445e17aSGeliang Tang 12386445e17aSGeliang Tang id1 = opts->rm_list.ids[i]; 12396445e17aSGeliang Tang id2 = i + 1 < opts->rm_list.nr ? opts->rm_list.ids[i + 1] : TCPOPT_NOP; 12406445e17aSGeliang Tang id3 = i + 2 < opts->rm_list.nr ? opts->rm_list.ids[i + 2] : TCPOPT_NOP; 12416445e17aSGeliang Tang id4 = i + 3 < opts->rm_list.nr ? opts->rm_list.ids[i + 3] : TCPOPT_NOP; 12426445e17aSGeliang Tang put_unaligned_be32(id1 << 24 | id2 << 16 | id3 << 8 | id4, ptr); 12436445e17aSGeliang Tang ptr += 1; 12446445e17aSGeliang Tang i += 4; 12456445e17aSGeliang Tang } 12463df523abSPeter Krystad } 12473df523abSPeter Krystad 124806706542SGeliang Tang if (OPTION_MPTCP_PRIO & opts->suboptions) { 124906706542SGeliang Tang const struct sock *ssk = (const struct sock *)tp; 125006706542SGeliang Tang struct mptcp_subflow_context *subflow; 125106706542SGeliang Tang 125206706542SGeliang Tang subflow = mptcp_subflow_ctx(ssk); 125306706542SGeliang Tang subflow->send_mp_prio = 0; 125406706542SGeliang Tang 125506706542SGeliang Tang *ptr++ = mptcp_option(MPTCPOPT_MP_PRIO, 125606706542SGeliang Tang TCPOLEN_MPTCP_PRIO, 125706706542SGeliang Tang opts->backup, TCPOPT_NOP); 125806706542SGeliang Tang } 125906706542SGeliang Tang 1260ec3edaa7SPeter Krystad if (OPTION_MPTCP_MPJ_SYN & opts->suboptions) { 1261ec3edaa7SPeter Krystad *ptr++ = mptcp_option(MPTCPOPT_MP_JOIN, 1262ec3edaa7SPeter Krystad TCPOLEN_MPTCP_MPJ_SYN, 1263ec3edaa7SPeter Krystad opts->backup, opts->join_id); 1264ec3edaa7SPeter Krystad put_unaligned_be32(opts->token, ptr); 1265ec3edaa7SPeter Krystad ptr += 1; 1266ec3edaa7SPeter Krystad put_unaligned_be32(opts->nonce, ptr); 1267ec3edaa7SPeter Krystad ptr += 1; 1268ec3edaa7SPeter Krystad } 1269ec3edaa7SPeter Krystad 1270f296234cSPeter Krystad if (OPTION_MPTCP_MPJ_SYNACK & opts->suboptions) { 1271f296234cSPeter Krystad *ptr++ = mptcp_option(MPTCPOPT_MP_JOIN, 1272f296234cSPeter Krystad TCPOLEN_MPTCP_MPJ_SYNACK, 1273f296234cSPeter Krystad opts->backup, opts->join_id); 1274f296234cSPeter Krystad put_unaligned_be64(opts->thmac, ptr); 1275f296234cSPeter Krystad ptr += 2; 1276f296234cSPeter Krystad put_unaligned_be32(opts->nonce, ptr); 1277f296234cSPeter Krystad ptr += 1; 1278f296234cSPeter Krystad } 1279f296234cSPeter Krystad 1280ec3edaa7SPeter Krystad if (OPTION_MPTCP_MPJ_ACK & opts->suboptions) { 1281ec3edaa7SPeter Krystad *ptr++ = mptcp_option(MPTCPOPT_MP_JOIN, 1282ec3edaa7SPeter Krystad TCPOLEN_MPTCP_MPJ_ACK, 0, 0); 1283ec3edaa7SPeter Krystad memcpy(ptr, opts->hmac, MPTCPOPT_HMAC_LEN); 1284ec3edaa7SPeter Krystad ptr += 5; 1285ec3edaa7SPeter Krystad } 1286ec3edaa7SPeter Krystad 12876d0060f6SMat Martineau if (opts->ext_copy.use_ack || opts->ext_copy.use_map) { 12886d0060f6SMat Martineau struct mptcp_ext *mpext = &opts->ext_copy; 12896d0060f6SMat Martineau u8 len = TCPOLEN_MPTCP_DSS_BASE; 12906d0060f6SMat Martineau u8 flags = 0; 12916d0060f6SMat Martineau 12926d0060f6SMat Martineau if (mpext->use_ack) { 1293a0c1d0eaSChristoph Paasch flags = MPTCP_DSS_HAS_ACK; 1294a0c1d0eaSChristoph Paasch if (mpext->ack64) { 12956d0060f6SMat Martineau len += TCPOLEN_MPTCP_DSS_ACK64; 1296a0c1d0eaSChristoph Paasch flags |= MPTCP_DSS_ACK64; 1297a0c1d0eaSChristoph Paasch } else { 1298a0c1d0eaSChristoph Paasch len += TCPOLEN_MPTCP_DSS_ACK32; 1299a0c1d0eaSChristoph Paasch } 13006d0060f6SMat Martineau } 13016d0060f6SMat Martineau 13026d0060f6SMat Martineau if (mpext->use_map) { 13036d0060f6SMat Martineau len += TCPOLEN_MPTCP_DSS_MAP64; 13046d0060f6SMat Martineau 13056d0060f6SMat Martineau /* Use only 64-bit mapping flags for now, add 13066d0060f6SMat Martineau * support for optional 32-bit mappings later. 13076d0060f6SMat Martineau */ 13086d0060f6SMat Martineau flags |= MPTCP_DSS_HAS_MAP | MPTCP_DSS_DSN64; 13096d0060f6SMat Martineau if (mpext->data_fin) 13106d0060f6SMat Martineau flags |= MPTCP_DSS_DATA_FIN; 13116d0060f6SMat Martineau } 13126d0060f6SMat Martineau 13133df523abSPeter Krystad *ptr++ = mptcp_option(MPTCPOPT_DSS, len, 0, flags); 13146d0060f6SMat Martineau 13156d0060f6SMat Martineau if (mpext->use_ack) { 1316a0c1d0eaSChristoph Paasch if (mpext->ack64) { 13176d0060f6SMat Martineau put_unaligned_be64(mpext->data_ack, ptr); 13186d0060f6SMat Martineau ptr += 2; 1319a0c1d0eaSChristoph Paasch } else { 1320a0c1d0eaSChristoph Paasch put_unaligned_be32(mpext->data_ack32, ptr); 1321a0c1d0eaSChristoph Paasch ptr += 1; 1322a0c1d0eaSChristoph Paasch } 13236d0060f6SMat Martineau } 13246d0060f6SMat Martineau 13256d0060f6SMat Martineau if (mpext->use_map) { 13266d0060f6SMat Martineau put_unaligned_be64(mpext->data_seq, ptr); 13276d0060f6SMat Martineau ptr += 2; 13286d0060f6SMat Martineau put_unaligned_be32(mpext->subflow_seq, ptr); 13296d0060f6SMat Martineau ptr += 1; 13306d0060f6SMat Martineau put_unaligned_be32(mpext->data_len << 16 | 13316d0060f6SMat Martineau TCPOPT_NOP << 8 | TCPOPT_NOP, ptr); 13326d0060f6SMat Martineau } 13336d0060f6SMat Martineau } 1334fa3fe2b1SFlorian Westphal 1335fa3fe2b1SFlorian Westphal if (tp) 1336fa3fe2b1SFlorian Westphal mptcp_set_rwin(tp); 1337eda7acddSPeter Krystad } 1338