[linux-block.git] / net / mptcp / diag.c

// SPDX-License-Identifier: GPL-2.0
/* MPTCP socket monitoring support
 *
 * Copyright (c) 2019 Red Hat
 *
 * Author: Davide Caratti <dcaratti@redhat.com>
 */

#include <linux/kernel.h>
#include <linux/net.h>
#include <linux/inet_diag.h>
#include <net/netlink.h>
#include "protocol.h"

static int subflow_get_info(struct sock *sk, struct sk_buff *skb)
{
	struct mptcp_subflow_context *sf;
	struct nlattr *start;
	u32 flags = 0;
	bool slow;
	int err;

	if (inet_sk_state_load(sk) == TCP_LISTEN)
		return 0;

	start = nla_nest_start_noflag(skb, INET_ULP_INFO_MPTCP);
	if (!start)
		return -EMSGSIZE;

	slow = lock_sock_fast(sk);
	rcu_read_lock();
	sf = rcu_dereference(inet_csk(sk)->icsk_ulp_data);
	if (!sf) {
		err = 0;
		goto nla_failure;
	}

	if (sf->mp_capable)
		flags |= MPTCP_SUBFLOW_FLAG_MCAP_REM;
	if (sf->request_mptcp)
		flags |= MPTCP_SUBFLOW_FLAG_MCAP_LOC;
	if (sf->mp_join)
		flags |= MPTCP_SUBFLOW_FLAG_JOIN_REM;
	if (sf->request_join)
		flags |= MPTCP_SUBFLOW_FLAG_JOIN_LOC;
	if (sf->backup)
		flags |= MPTCP_SUBFLOW_FLAG_BKUP_REM;
	if (sf->request_bkup)
		flags |= MPTCP_SUBFLOW_FLAG_BKUP_LOC;
	if (sf->fully_established)
		flags |= MPTCP_SUBFLOW_FLAG_FULLY_ESTABLISHED;
	if (sf->conn_finished)
		flags |= MPTCP_SUBFLOW_FLAG_CONNECTED;
	if (sf->map_valid)
		flags |= MPTCP_SUBFLOW_FLAG_MAPVALID;

	if (nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_TOKEN_REM, sf->remote_token) ||
	    nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_TOKEN_LOC, sf->token) ||
	    nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_RELWRITE_SEQ,
			sf->rel_write_seq) ||
	    nla_put_u64_64bit(skb, MPTCP_SUBFLOW_ATTR_MAP_SEQ, sf->map_seq,
			      MPTCP_SUBFLOW_ATTR_PAD) ||
	    nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_MAP_SFSEQ,
			sf->map_subflow_seq) ||
	    nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_SSN_OFFSET, sf->ssn_offset) ||
	    nla_put_u16(skb, MPTCP_SUBFLOW_ATTR_MAP_DATALEN,
			sf->map_data_len) ||
	    nla_put_u32(skb, MPTCP_SUBFLOW_ATTR_FLAGS, flags) ||
	    nla_put_u8(skb, MPTCP_SUBFLOW_ATTR_ID_REM, sf->remote_id) ||
	    nla_put_u8(skb, MPTCP_SUBFLOW_ATTR_ID_LOC, subflow_get_local_id(sf))) {
		err = -EMSGSIZE;
		goto nla_failure;
	}

	rcu_read_unlock();
	unlock_sock_fast(sk, slow);
	nla_nest_end(skb, start);
	return 0;

nla_failure:
	rcu_read_unlock();
	unlock_sock_fast(sk, slow);
	nla_nest_cancel(skb, start);
	return err;
}

static size_t subflow_get_info_size(const struct sock *sk)
{
	size_t size = 0;

	size += nla_total_size(0) +	/* INET_ULP_INFO_MPTCP */
		nla_total_size(4) +	/* MPTCP_SUBFLOW_ATTR_TOKEN_REM */
		nla_total_size(4) +	/* MPTCP_SUBFLOW_ATTR_TOKEN_LOC */
		nla_total_size(4) +	/* MPTCP_SUBFLOW_ATTR_RELWRITE_SEQ */
		nla_total_size_64bit(8) +	/* MPTCP_SUBFLOW_ATTR_MAP_SEQ */
		nla_total_size(4) +	/* MPTCP_SUBFLOW_ATTR_MAP_SFSEQ */
		nla_total_size(2) +	/* MPTCP_SUBFLOW_ATTR_SSN_OFFSET */
		nla_total_size(2) +	/* MPTCP_SUBFLOW_ATTR_MAP_DATALEN */
		nla_total_size(4) +	/* MPTCP_SUBFLOW_ATTR_FLAGS */
		nla_total_size(1) +	/* MPTCP_SUBFLOW_ATTR_ID_REM */
		nla_total_size(1) +	/* MPTCP_SUBFLOW_ATTR_ID_LOC */
		0;
	return size;
}

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