[mirror_iproute2.git] / rdma / res-cmid.c

// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
/*
 * res-cmid.c	RDMA tool
 * Authors:     Leon Romanovsky <leonro@mellanox.com>
 */

#include "res.h"
#include <inttypes.h>

static void print_qp_type(struct rd *rd, uint32_t val)
{
	if (rd->json_output)
		jsonw_string_field(rd->jw, "qp-type", qp_types_to_str(val));
	else
		pr_out("qp-type %s ", qp_types_to_str(val));
}

static const char *cm_id_state_to_str(uint8_t idx)
{
	static const char *const cm_id_states_str[] = {
		"IDLE",		  "ADDR_QUERY",     "ADDR_RESOLVED",
		"ROUTE_QUERY",    "ROUTE_RESOLVED", "CONNECT",
		"DISCONNECT",     "ADDR_BOUND",     "LISTEN",
		"DEVICE_REMOVAL", "DESTROYING"
	};

	if (idx < ARRAY_SIZE(cm_id_states_str))
		return cm_id_states_str[idx];
	return "UNKNOWN";
}

static const char *cm_id_ps_to_str(uint32_t ps)
{
	switch (ps) {
	case RDMA_PS_IPOIB:
		return "IPoIB";
	case RDMA_PS_IB:
		return "IPoIB";
	case RDMA_PS_TCP:
		return "TCP";
	case RDMA_PS_UDP:
		return "UDP";
	default:
		return "---";
	}
}

static void print_cm_id_state(struct rd *rd, uint8_t state)
{
	if (rd->json_output) {
		jsonw_string_field(rd->jw, "state", cm_id_state_to_str(state));
		return;
	}
	pr_out("state %s ", cm_id_state_to_str(state));
}

static void print_ps(struct rd *rd, uint32_t ps)
{
	if (rd->json_output) {
		jsonw_string_field(rd->jw, "ps", cm_id_ps_to_str(ps));
		return;
	}
	pr_out("ps %s ", cm_id_ps_to_str(ps));
}

static void print_ipaddr(struct rd *rd, const char *key, char *addrstr,
			 uint16_t port)
{
	if (rd->json_output) {
		int name_size = INET6_ADDRSTRLEN + strlen(":65535");
		char json_name[name_size];

		snprintf(json_name, name_size, "%s:%u", addrstr, port);
		jsonw_string_field(rd->jw, key, json_name);
		return;
	}
	pr_out("%s %s:%u ", key, addrstr, port);
}

static int ss_ntop(struct nlattr *nla_line, char *addr_str, uint16_t *port)
{
	struct __kernel_sockaddr_storage *addr;

	addr = (struct __kernel_sockaddr_storage *)mnl_attr_get_payload(
		nla_line);
	switch (addr->ss_family) {
	case AF_INET: {
		struct sockaddr_in *sin = (struct sockaddr_in *)addr;

		if (!inet_ntop(AF_INET, (const void *)&sin->sin_addr, addr_str,
			       INET6_ADDRSTRLEN))
			return -EINVAL;
		*port = ntohs(sin->sin_port);
		break;
	}
	case AF_INET6: {
		struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)addr;

		if (!inet_ntop(AF_INET6, (const void *)&sin6->sin6_addr,
			       addr_str, INET6_ADDRSTRLEN))
			return -EINVAL;
		*port = ntohs(sin6->sin6_port);
		break;
	}
	default:
		return -EINVAL;
	}
	return 0;
}

static int res_cm_id_line(struct rd *rd, const char *name, int idx,
			  struct nlattr *nla_entry)
{
	struct nlattr *nla_line[RDMA_NLDEV_ATTR_MAX] = {};
	char src_addr_str[INET6_ADDRSTRLEN];
	char dst_addr_str[INET6_ADDRSTRLEN];
	uint16_t src_port, dst_port;
	uint32_t port = 0, pid = 0;
	uint8_t type = 0, state;
	uint32_t lqpn = 0, ps;
	uint32_t cm_idn = 0;
	char *comm = NULL;
	int err;

	err = mnl_attr_parse_nested(nla_entry, rd_attr_cb, nla_line);
	if (err != MNL_CB_OK)
		return MNL_CB_ERROR;

	if (!nla_line[RDMA_NLDEV_ATTR_RES_STATE] ||
	    !nla_line[RDMA_NLDEV_ATTR_RES_PS] ||
	    (!nla_line[RDMA_NLDEV_ATTR_RES_PID] &&
	     !nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME])) {
		return MNL_CB_ERROR;
	}

	if (nla_line[RDMA_NLDEV_ATTR_PORT_INDEX])
		port = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_PORT_INDEX]);

	if (port && port != rd->port_idx)
		goto out;

	if (nla_line[RDMA_NLDEV_ATTR_RES_LQPN]) {
		lqpn = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_LQPN]);
		if (rd_check_is_filtered(rd, "lqpn", lqpn))
			goto out;
	}
	if (nla_line[RDMA_NLDEV_ATTR_RES_TYPE]) {
		type = mnl_attr_get_u8(nla_line[RDMA_NLDEV_ATTR_RES_TYPE]);
		if (rd_check_is_string_filtered(rd, "qp-type",
						qp_types_to_str(type)))
			goto out;
	}

	ps = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_PS]);
	if (rd_check_is_string_filtered(rd, "ps", cm_id_ps_to_str(ps)))
		goto out;

	state = mnl_attr_get_u8(nla_line[RDMA_NLDEV_ATTR_RES_STATE]);
	if (rd_check_is_string_filtered(rd, "state", cm_id_state_to_str(state)))
		goto out;

	if (nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR]) {
		if (ss_ntop(nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR],
			    src_addr_str, &src_port))
			goto out;
		if (rd_check_is_string_filtered(rd, "src-addr", src_addr_str))
			goto out;
		if (rd_check_is_filtered(rd, "src-port", src_port))
			goto out;
	}

	if (nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR]) {
		if (ss_ntop(nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR],
			    dst_addr_str, &dst_port))
			goto out;
		if (rd_check_is_string_filtered(rd, "dst-addr", dst_addr_str))
			goto out;
		if (rd_check_is_filtered(rd, "dst-port", dst_port))
			goto out;
	}

	if (nla_line[RDMA_NLDEV_ATTR_RES_PID]) {
		pid = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_PID]);
		comm = get_task_name(pid);
	}

	if (rd_check_is_filtered(rd, "pid", pid))
		goto out;

	if (nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN])
		cm_idn = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN]);
	if (rd_check_is_filtered(rd, "cm-idn", cm_idn))
		goto out;

	if (nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME]) {
		/* discard const from mnl_attr_get_str */
		comm = (char *)mnl_attr_get_str(
			nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME]);
	}

	if (rd->json_output)
		jsonw_start_array(rd->jw);

	print_link(rd, idx, name, port, nla_line);
	if (nla_line[RDMA_NLDEV_ATTR_RES_LQPN])
		res_print_uint(rd, "lqpn", lqpn);
	if (nla_line[RDMA_NLDEV_ATTR_RES_TYPE])
		print_qp_type(rd, type);
	print_cm_id_state(rd, state);
	print_ps(rd, ps);
	res_print_uint(rd, "pid", pid);
	print_comm(rd, comm, nla_line);
	if (nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN])
		res_print_uint(rd, "cm-idn", cm_idn);

	if (nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR])
		print_ipaddr(rd, "src-addr", src_addr_str, src_port);
	if (nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR])
		print_ipaddr(rd, "dst-addr", dst_addr_str, dst_port);

	print_driver_table(rd, nla_line[RDMA_NLDEV_ATTR_DRIVER]);
	newline(rd);

out:	if (nla_line[RDMA_NLDEV_ATTR_RES_PID])
		free(comm);
	return MNL_CB_OK;
}

int res_cm_id_parse_cb(const struct nlmsghdr *nlh, void *data)
{
	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX] = {};
	struct nlattr *nla_table, *nla_entry;
	struct rd *rd = data;
	int ret = MNL_CB_OK;
	const char *name;
	int idx;

	mnl_attr_parse(nlh, 0, rd_attr_cb, tb);
	if (!tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_DEV_NAME] ||
	    !tb[RDMA_NLDEV_ATTR_RES_CM_ID])
		return MNL_CB_ERROR;

	name = mnl_attr_get_str(tb[RDMA_NLDEV_ATTR_DEV_NAME]);
	idx = mnl_attr_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
	nla_table = tb[RDMA_NLDEV_ATTR_RES_CM_ID];

	mnl_attr_for_each_nested(nla_entry, nla_table) {
		ret = res_cm_id_line(rd, name, idx, nla_entry);

		if (ret != MNL_CB_OK)
			break;
	}
	return ret;
}
Commit	Line	Data
438fac3a LR	1	// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
	2	/*
	3	* res-cmid.c RDMA tool
	4	* Authors: Leon Romanovsky <leonro@mellanox.com>
	5	*/
	6
	7	#include "res.h"
	8	#include <inttypes.h>
	9
	10	static void print_qp_type(struct rd *rd, uint32_t val)
	11	{
	12	if (rd->json_output)
	13	jsonw_string_field(rd->jw, "qp-type", qp_types_to_str(val));
	14	else
	15	pr_out("qp-type %s ", qp_types_to_str(val));
	16	}
	17
	18	static const char *cm_id_state_to_str(uint8_t idx)
	19	{
	20	static const char *const cm_id_states_str[] = {
	21	"IDLE", "ADDR_QUERY", "ADDR_RESOLVED",
	22	"ROUTE_QUERY", "ROUTE_RESOLVED", "CONNECT",
	23	"DISCONNECT", "ADDR_BOUND", "LISTEN",
	24	"DEVICE_REMOVAL", "DESTROYING"
	25	};
	26
	27	if (idx < ARRAY_SIZE(cm_id_states_str))
	28	return cm_id_states_str[idx];
	29	return "UNKNOWN";
	30	}
	31
	32	static const char *cm_id_ps_to_str(uint32_t ps)
	33	{
	34	switch (ps) {
	35	case RDMA_PS_IPOIB:
	36	return "IPoIB";
	37	case RDMA_PS_IB:
	38	return "IPoIB";
	39	case RDMA_PS_TCP:
	40	return "TCP";
	41	case RDMA_PS_UDP:
	42	return "UDP";
	43	default:
	44	return "---";
	45	}
	46	}
	47
	48	static void print_cm_id_state(struct rd *rd, uint8_t state)
	49	{
	50	if (rd->json_output) {
	51	jsonw_string_field(rd->jw, "state", cm_id_state_to_str(state));
	52	return;
	53	}
	54	pr_out("state %s ", cm_id_state_to_str(state));
	55	}
	56
	57	static void print_ps(struct rd *rd, uint32_t ps)
	58	{
	59	if (rd->json_output) {
	60	jsonw_string_field(rd->jw, "ps", cm_id_ps_to_str(ps));
	61	return;
	62	}
	63	pr_out("ps %s ", cm_id_ps_to_str(ps));
	64	}
65
66	static void print_ipaddr(struct rd rd, const char key, char *addrstr,
67	uint16_t port)
68	{
69	if (rd->json_output) {
70	int name_size = INET6_ADDRSTRLEN + strlen(":65535");
71	char json_name[name_size];
72
73	snprintf(json_name, name_size, "%s:%u", addrstr, port);
74	jsonw_string_field(rd->jw, key, json_name);
75	return;
76	}
77	pr_out("%s %s:%u ", key, addrstr, port);
78	}
79
80	static int ss_ntop(struct nlattr nla_line, char addr_str, uint16_t *port)
81	{
82	struct __kernel_sockaddr_storage *addr;
83
84	addr = (struct __kernel_sockaddr_storage *)mnl_attr_get_payload(
85	nla_line);
86	switch (addr->ss_family) {
87	case AF_INET: {
88	struct sockaddr_in sin = (struct sockaddr_in )addr;
89
90	if (!inet_ntop(AF_INET, (const void *)&sin->sin_addr, addr_str,
91	INET6_ADDRSTRLEN))
92	return -EINVAL;
93	*port = ntohs(sin->sin_port);
94	break;
95	}
96	case AF_INET6: {
97	struct sockaddr_in6 sin6 = (struct sockaddr_in6 )addr;
98
99	if (!inet_ntop(AF_INET6, (const void *)&sin6->sin6_addr,
100	addr_str, INET6_ADDRSTRLEN))
101	return -EINVAL;
102	*port = ntohs(sin6->sin6_port);
103	break;
104	}
105	default:
106	return -EINVAL;
107	}
108	return 0;
109	}
110
7d06b31f LR	111	static int res_cm_id_line(struct rd rd, const char name, int idx,
	112	struct nlattr *nla_entry)
	113	{
	114	struct nlattr *nla_line[RDMA_NLDEV_ATTR_MAX] = {};
	115	char src_addr_str[INET6_ADDRSTRLEN];
	116	char dst_addr_str[INET6_ADDRSTRLEN];
	117	uint16_t src_port, dst_port;
	118	uint32_t port = 0, pid = 0;
	119	uint8_t type = 0, state;
	120	uint32_t lqpn = 0, ps;
	121	uint32_t cm_idn = 0;
	122	char *comm = NULL;
	123	int err;
	124
	125	err = mnl_attr_parse_nested(nla_entry, rd_attr_cb, nla_line);
	126	if (err != MNL_CB_OK)
	127	return MNL_CB_ERROR;
	128
	129	if (!nla_line[RDMA_NLDEV_ATTR_RES_STATE] \|\|
	130	!nla_line[RDMA_NLDEV_ATTR_RES_PS] \|\|
	131	(!nla_line[RDMA_NLDEV_ATTR_RES_PID] &&
	132	!nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME])) {
	133	return MNL_CB_ERROR;
	134	}
	135
	136	if (nla_line[RDMA_NLDEV_ATTR_PORT_INDEX])
	137	port = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_PORT_INDEX]);
	138
	139	if (port && port != rd->port_idx)
	140	goto out;
	141
	142	if (nla_line[RDMA_NLDEV_ATTR_RES_LQPN]) {
	143	lqpn = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_LQPN]);
	144	if (rd_check_is_filtered(rd, "lqpn", lqpn))
	145	goto out;
	146	}
	147	if (nla_line[RDMA_NLDEV_ATTR_RES_TYPE]) {
	148	type = mnl_attr_get_u8(nla_line[RDMA_NLDEV_ATTR_RES_TYPE]);
	149	if (rd_check_is_string_filtered(rd, "qp-type",
	150	qp_types_to_str(type)))
	151	goto out;
	152	}
	153
	154	ps = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_PS]);
	155	if (rd_check_is_string_filtered(rd, "ps", cm_id_ps_to_str(ps)))
	156	goto out;
	157
	158	state = mnl_attr_get_u8(nla_line[RDMA_NLDEV_ATTR_RES_STATE]);
	159	if (rd_check_is_string_filtered(rd, "state", cm_id_state_to_str(state)))
	160	goto out;
	161
	162	if (nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR]) {
	163	if (ss_ntop(nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR],
	164	src_addr_str, &src_port))
	165	goto out;
	166	if (rd_check_is_string_filtered(rd, "src-addr", src_addr_str))
	167	goto out;
	168	if (rd_check_is_filtered(rd, "src-port", src_port))
	169	goto out;
	170	}
	171
	172	if (nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR]) {
	173	if (ss_ntop(nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR],
	174	dst_addr_str, &dst_port))
175	goto out;
176	if (rd_check_is_string_filtered(rd, "dst-addr", dst_addr_str))
177	goto out;
178	if (rd_check_is_filtered(rd, "dst-port", dst_port))
179	goto out;
180	}
181
182	if (nla_line[RDMA_NLDEV_ATTR_RES_PID]) {
183	pid = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_PID]);
184	comm = get_task_name(pid);
185	}
186
187	if (rd_check_is_filtered(rd, "pid", pid))
188	goto out;
189
190	if (nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN])
191	cm_idn = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN]);
192	if (rd_check_is_filtered(rd, "cm-idn", cm_idn))
193	goto out;
194
195	if (nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME]) {
196	/* discard const from mnl_attr_get_str */
197	comm = (char *)mnl_attr_get_str(
198	nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME]);
199	}
200
201	if (rd->json_output)
202	jsonw_start_array(rd->jw);
203
204	print_link(rd, idx, name, port, nla_line);
205	if (nla_line[RDMA_NLDEV_ATTR_RES_LQPN])
206	res_print_uint(rd, "lqpn", lqpn);
207	if (nla_line[RDMA_NLDEV_ATTR_RES_TYPE])
208	print_qp_type(rd, type);
209	print_cm_id_state(rd, state);
210	print_ps(rd, ps);
211	res_print_uint(rd, "pid", pid);
212	print_comm(rd, comm, nla_line);
213	if (nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN])
214	res_print_uint(rd, "cm-idn", cm_idn);
215
216	if (nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR])
217	print_ipaddr(rd, "src-addr", src_addr_str, src_port);
218	if (nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR])
219	print_ipaddr(rd, "dst-addr", dst_addr_str, dst_port);
220
221	print_driver_table(rd, nla_line[RDMA_NLDEV_ATTR_DRIVER]);
222	newline(rd);
223
224	out: if (nla_line[RDMA_NLDEV_ATTR_RES_PID])
225	free(comm);
226	return MNL_CB_OK;
227	}
228
438fac3a LR	229	int res_cm_id_parse_cb(const struct nlmsghdr nlh, void data)
	230	{
	231	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX] = {};
	232	struct nlattr nla_table, nla_entry;
	233	struct rd *rd = data;
7d06b31f	234	int ret = MNL_CB_OK;
438fac3a LR	235	const char *name;
	236	int idx;
	237
	238	mnl_attr_parse(nlh, 0, rd_attr_cb, tb);
	239	if (!tb[RDMA_NLDEV_ATTR_DEV_INDEX] \|\| !tb[RDMA_NLDEV_ATTR_DEV_NAME] \|\|
	240	!tb[RDMA_NLDEV_ATTR_RES_CM_ID])
	241	return MNL_CB_ERROR;
	242
	243	name = mnl_attr_get_str(tb[RDMA_NLDEV_ATTR_DEV_NAME]);
	244	idx = mnl_attr_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
	245	nla_table = tb[RDMA_NLDEV_ATTR_RES_CM_ID];
7d06b31f	246
438fac3a	247	mnl_attr_for_each_nested(nla_entry, nla_table) {
7d06b31f	248	ret = res_cm_id_line(rd, name, idx, nla_entry);
438fac3a	249
7d06b31f LR	250	if (ret != MNL_CB_OK)
7d06b31f LR	251	break;
438fac3a	252	}
7d06b31f	253	return ret;
438fac3a	254	}