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