^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /* MPTCP socket monitoring support
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (c) 2019 Red Hat
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Author: Davide Caratti <dcaratti@redhat.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/net.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/inet_diag.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <net/netlink.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <uapi/linux/mptcp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include "protocol.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) static int subflow_get_info(const struct sock *sk, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) struct mptcp_subflow_context *sf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) struct nlattr *start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) u32 flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) start = nla_nest_start_noflag(skb, INET_ULP_INFO_MPTCP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) if (!start)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) return -EMSGSIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) rcu_read_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) sf = rcu_dereference(inet_csk(sk)->icsk_ulp_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) if (!sf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) goto nla_failure;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) if (sf->mp_capable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) flags |= MPTCP_SUBFLOW_FLAG_MCAP_REM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) if (sf->request_mptcp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) flags |= MPTCP_SUBFLOW_FLAG_MCAP_LOC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) if (sf->mp_join)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) flags |= MPTCP_SUBFLOW_FLAG_JOIN_REM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) if (sf->request_join)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) flags |= MPTCP_SUBFLOW_FLAG_JOIN_LOC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) if (sf->backup)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) flags |= MPTCP_SUBFLOW_FLAG_BKUP_REM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) if (sf->request_bkup)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) flags |= MPTCP_SUBFLOW_FLAG_BKUP_LOC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) if (sf->fully_established)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) flags |= MPTCP_SUBFLOW_FLAG_FULLY_ESTABLISHED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) if (sf->conn_finished)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) flags |= MPTCP_SUBFLOW_FLAG_CONNECTED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) if (sf->map_valid)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) flags |= MPTCP_SUBFLOW_FLAG_MAPVALID;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) if (nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_TOKEN_REM, sf->remote_token) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_TOKEN_LOC, sf->token) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_RELWRITE_SEQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) sf->rel_write_seq) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) nla_put_u64_64bit(skb, MPTCP_SUBFLOW_ATTR_MAP_SEQ, sf->map_seq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) MPTCP_SUBFLOW_ATTR_PAD) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_MAP_SFSEQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) sf->map_subflow_seq) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_SSN_OFFSET, sf->ssn_offset) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) nla_put_u16(skb, MPTCP_SUBFLOW_ATTR_MAP_DATALEN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) sf->map_data_len) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_FLAGS, flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) nla_put_u8(skb, MPTCP_SUBFLOW_ATTR_ID_REM, sf->remote_id) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) nla_put_u8(skb, MPTCP_SUBFLOW_ATTR_ID_LOC, sf->local_id)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) err = -EMSGSIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) goto nla_failure;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) rcu_read_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) nla_nest_end(skb, start);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) nla_failure:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) rcu_read_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) nla_nest_cancel(skb, start);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) static size_t subflow_get_info_size(const struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) size_t size = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) size += nla_total_size(0) + /* INET_ULP_INFO_MPTCP */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) nla_total_size(4) + /* MPTCP_SUBFLOW_ATTR_TOKEN_REM */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) nla_total_size(4) + /* MPTCP_SUBFLOW_ATTR_TOKEN_LOC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) nla_total_size(4) + /* MPTCP_SUBFLOW_ATTR_RELWRITE_SEQ */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) nla_total_size_64bit(8) + /* MPTCP_SUBFLOW_ATTR_MAP_SEQ */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) nla_total_size(4) + /* MPTCP_SUBFLOW_ATTR_MAP_SFSEQ */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) nla_total_size(2) + /* MPTCP_SUBFLOW_ATTR_SSN_OFFSET */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) nla_total_size(2) + /* MPTCP_SUBFLOW_ATTR_MAP_DATALEN */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) nla_total_size(4) + /* MPTCP_SUBFLOW_ATTR_FLAGS */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) nla_total_size(1) + /* MPTCP_SUBFLOW_ATTR_ID_REM */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) nla_total_size(1) + /* MPTCP_SUBFLOW_ATTR_ID_LOC */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) return size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) void mptcp_diag_subflow_init(struct tcp_ulp_ops *ops)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) ops->get_info = subflow_get_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) ops->get_info_size = subflow_get_info_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags