Linux Audio

Check our new training course

Loading...
v6.8
   1/*
   2 * Copyright (c) 2017 Mellanox Technologies. All rights reserved.
   3 *
   4 * Redistribution and use in source and binary forms, with or without
   5 * modification, are permitted provided that the following conditions are met:
   6 *
   7 * 1. Redistributions of source code must retain the above copyright
   8 *    notice, this list of conditions and the following disclaimer.
   9 * 2. Redistributions in binary form must reproduce the above copyright
  10 *    notice, this list of conditions and the following disclaimer in the
  11 *    documentation and/or other materials provided with the distribution.
  12 * 3. Neither the names of the copyright holders nor the names of its
  13 *    contributors may be used to endorse or promote products derived from
  14 *    this software without specific prior written permission.
  15 *
  16 * Alternatively, this software may be distributed under the terms of the
  17 * GNU General Public License ("GPL") version 2 as published by the Free
  18 * Software Foundation.
  19 *
  20 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  21 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  23 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  24 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  25 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  30 * POSSIBILITY OF SUCH DAMAGE.
  31 */
  32
  33#include <linux/module.h>
  34#include <linux/pid.h>
  35#include <linux/pid_namespace.h>
  36#include <linux/mutex.h>
  37#include <net/netlink.h>
  38#include <rdma/rdma_cm.h>
  39#include <rdma/rdma_netlink.h>
  40
  41#include "core_priv.h"
  42#include "cma_priv.h"
  43#include "restrack.h"
  44#include "uverbs.h"
  45
  46/*
  47 * This determines whether a non-privileged user is allowed to specify a
  48 * controlled QKEY or not, when true non-privileged user is allowed to specify
  49 * a controlled QKEY.
  50 */
  51static bool privileged_qkey;
  52
  53typedef int (*res_fill_func_t)(struct sk_buff*, bool,
  54			       struct rdma_restrack_entry*, uint32_t);
  55
  56/*
  57 * Sort array elements by the netlink attribute name
  58 */
  59static const struct nla_policy nldev_policy[RDMA_NLDEV_ATTR_MAX] = {
  60	[RDMA_NLDEV_ATTR_CHARDEV]		= { .type = NLA_U64 },
  61	[RDMA_NLDEV_ATTR_CHARDEV_ABI]		= { .type = NLA_U64 },
  62	[RDMA_NLDEV_ATTR_CHARDEV_NAME]		= { .type = NLA_NUL_STRING,
  63					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  64	[RDMA_NLDEV_ATTR_CHARDEV_TYPE]		= { .type = NLA_NUL_STRING,
  65					.len = RDMA_NLDEV_ATTR_CHARDEV_TYPE_SIZE },
  66	[RDMA_NLDEV_ATTR_DEV_DIM]               = { .type = NLA_U8 },
  67	[RDMA_NLDEV_ATTR_DEV_INDEX]		= { .type = NLA_U32 },
  68	[RDMA_NLDEV_ATTR_DEV_NAME]		= { .type = NLA_NUL_STRING,
  69					.len = IB_DEVICE_NAME_MAX },
  70	[RDMA_NLDEV_ATTR_DEV_NODE_TYPE]		= { .type = NLA_U8 },
  71	[RDMA_NLDEV_ATTR_DEV_PROTOCOL]		= { .type = NLA_NUL_STRING,
  72					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  73	[RDMA_NLDEV_ATTR_DRIVER]		= { .type = NLA_NESTED },
  74	[RDMA_NLDEV_ATTR_DRIVER_ENTRY]		= { .type = NLA_NESTED },
  75	[RDMA_NLDEV_ATTR_DRIVER_PRINT_TYPE]	= { .type = NLA_U8 },
  76	[RDMA_NLDEV_ATTR_DRIVER_STRING]		= { .type = NLA_NUL_STRING,
  77					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  78	[RDMA_NLDEV_ATTR_DRIVER_S32]		= { .type = NLA_S32 },
  79	[RDMA_NLDEV_ATTR_DRIVER_S64]		= { .type = NLA_S64 },
  80	[RDMA_NLDEV_ATTR_DRIVER_U32]		= { .type = NLA_U32 },
  81	[RDMA_NLDEV_ATTR_DRIVER_U64]		= { .type = NLA_U64 },
  82	[RDMA_NLDEV_ATTR_FW_VERSION]		= { .type = NLA_NUL_STRING,
  83					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  84	[RDMA_NLDEV_ATTR_LID]			= { .type = NLA_U32 },
  85	[RDMA_NLDEV_ATTR_LINK_TYPE]		= { .type = NLA_NUL_STRING,
  86					.len = IFNAMSIZ },
  87	[RDMA_NLDEV_ATTR_LMC]			= { .type = NLA_U8 },
  88	[RDMA_NLDEV_ATTR_NDEV_INDEX]		= { .type = NLA_U32 },
  89	[RDMA_NLDEV_ATTR_NDEV_NAME]		= { .type = NLA_NUL_STRING,
  90					.len = IFNAMSIZ },
  91	[RDMA_NLDEV_ATTR_NODE_GUID]		= { .type = NLA_U64 },
  92	[RDMA_NLDEV_ATTR_PORT_INDEX]		= { .type = NLA_U32 },
  93	[RDMA_NLDEV_ATTR_PORT_PHYS_STATE]	= { .type = NLA_U8 },
  94	[RDMA_NLDEV_ATTR_PORT_STATE]		= { .type = NLA_U8 },
  95	[RDMA_NLDEV_ATTR_RES_CM_ID]		= { .type = NLA_NESTED },
  96	[RDMA_NLDEV_ATTR_RES_CM_IDN]		= { .type = NLA_U32 },
  97	[RDMA_NLDEV_ATTR_RES_CM_ID_ENTRY]	= { .type = NLA_NESTED },
  98	[RDMA_NLDEV_ATTR_RES_CQ]		= { .type = NLA_NESTED },
  99	[RDMA_NLDEV_ATTR_RES_CQE]		= { .type = NLA_U32 },
 100	[RDMA_NLDEV_ATTR_RES_CQN]		= { .type = NLA_U32 },
 101	[RDMA_NLDEV_ATTR_RES_CQ_ENTRY]		= { .type = NLA_NESTED },
 102	[RDMA_NLDEV_ATTR_RES_CTX]		= { .type = NLA_NESTED },
 103	[RDMA_NLDEV_ATTR_RES_CTXN]		= { .type = NLA_U32 },
 104	[RDMA_NLDEV_ATTR_RES_CTX_ENTRY]		= { .type = NLA_NESTED },
 105	[RDMA_NLDEV_ATTR_RES_DST_ADDR]		= {
 106			.len = sizeof(struct __kernel_sockaddr_storage) },
 107	[RDMA_NLDEV_ATTR_RES_IOVA]		= { .type = NLA_U64 },
 108	[RDMA_NLDEV_ATTR_RES_KERN_NAME]		= { .type = NLA_NUL_STRING,
 109					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
 110	[RDMA_NLDEV_ATTR_RES_LKEY]		= { .type = NLA_U32 },
 111	[RDMA_NLDEV_ATTR_RES_LOCAL_DMA_LKEY]	= { .type = NLA_U32 },
 112	[RDMA_NLDEV_ATTR_RES_LQPN]		= { .type = NLA_U32 },
 113	[RDMA_NLDEV_ATTR_RES_MR]		= { .type = NLA_NESTED },
 114	[RDMA_NLDEV_ATTR_RES_MRLEN]		= { .type = NLA_U64 },
 115	[RDMA_NLDEV_ATTR_RES_MRN]		= { .type = NLA_U32 },
 116	[RDMA_NLDEV_ATTR_RES_MR_ENTRY]		= { .type = NLA_NESTED },
 117	[RDMA_NLDEV_ATTR_RES_PATH_MIG_STATE]	= { .type = NLA_U8 },
 118	[RDMA_NLDEV_ATTR_RES_PD]		= { .type = NLA_NESTED },
 119	[RDMA_NLDEV_ATTR_RES_PDN]		= { .type = NLA_U32 },
 120	[RDMA_NLDEV_ATTR_RES_PD_ENTRY]		= { .type = NLA_NESTED },
 121	[RDMA_NLDEV_ATTR_RES_PID]		= { .type = NLA_U32 },
 122	[RDMA_NLDEV_ATTR_RES_POLL_CTX]		= { .type = NLA_U8 },
 123	[RDMA_NLDEV_ATTR_RES_PS]		= { .type = NLA_U32 },
 124	[RDMA_NLDEV_ATTR_RES_QP]		= { .type = NLA_NESTED },
 125	[RDMA_NLDEV_ATTR_RES_QP_ENTRY]		= { .type = NLA_NESTED },
 126	[RDMA_NLDEV_ATTR_RES_RAW]		= { .type = NLA_BINARY },
 127	[RDMA_NLDEV_ATTR_RES_RKEY]		= { .type = NLA_U32 },
 128	[RDMA_NLDEV_ATTR_RES_RQPN]		= { .type = NLA_U32 },
 129	[RDMA_NLDEV_ATTR_RES_RQ_PSN]		= { .type = NLA_U32 },
 130	[RDMA_NLDEV_ATTR_RES_SQ_PSN]		= { .type = NLA_U32 },
 131	[RDMA_NLDEV_ATTR_RES_SRC_ADDR]		= {
 132			.len = sizeof(struct __kernel_sockaddr_storage) },
 133	[RDMA_NLDEV_ATTR_RES_STATE]		= { .type = NLA_U8 },
 134	[RDMA_NLDEV_ATTR_RES_SUMMARY]		= { .type = NLA_NESTED },
 135	[RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY]	= { .type = NLA_NESTED },
 136	[RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY_CURR]= { .type = NLA_U64 },
 137	[RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY_NAME]= { .type = NLA_NUL_STRING,
 138					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
 139	[RDMA_NLDEV_ATTR_RES_TYPE]		= { .type = NLA_U8 },
 140	[RDMA_NLDEV_ATTR_RES_UNSAFE_GLOBAL_RKEY]= { .type = NLA_U32 },
 141	[RDMA_NLDEV_ATTR_RES_USECNT]		= { .type = NLA_U64 },
 142	[RDMA_NLDEV_ATTR_RES_SRQ]		= { .type = NLA_NESTED },
 143	[RDMA_NLDEV_ATTR_RES_SRQN]		= { .type = NLA_U32 },
 144	[RDMA_NLDEV_ATTR_RES_SRQ_ENTRY]		= { .type = NLA_NESTED },
 145	[RDMA_NLDEV_ATTR_MIN_RANGE]		= { .type = NLA_U32 },
 146	[RDMA_NLDEV_ATTR_MAX_RANGE]		= { .type = NLA_U32 },
 147	[RDMA_NLDEV_ATTR_SM_LID]		= { .type = NLA_U32 },
 148	[RDMA_NLDEV_ATTR_SUBNET_PREFIX]		= { .type = NLA_U64 },
 149	[RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK]	= { .type = NLA_U32 },
 150	[RDMA_NLDEV_ATTR_STAT_MODE]		= { .type = NLA_U32 },
 151	[RDMA_NLDEV_ATTR_STAT_RES]		= { .type = NLA_U32 },
 152	[RDMA_NLDEV_ATTR_STAT_COUNTER]		= { .type = NLA_NESTED },
 153	[RDMA_NLDEV_ATTR_STAT_COUNTER_ENTRY]	= { .type = NLA_NESTED },
 154	[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]       = { .type = NLA_U32 },
 155	[RDMA_NLDEV_ATTR_STAT_HWCOUNTERS]       = { .type = NLA_NESTED },
 156	[RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY]  = { .type = NLA_NESTED },
 157	[RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_NAME] = { .type = NLA_NUL_STRING },
 158	[RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_VALUE] = { .type = NLA_U64 },
 159	[RDMA_NLDEV_ATTR_SYS_IMAGE_GUID]	= { .type = NLA_U64 },
 160	[RDMA_NLDEV_ATTR_UVERBS_DRIVER_ID]	= { .type = NLA_U32 },
 161	[RDMA_NLDEV_NET_NS_FD]			= { .type = NLA_U32 },
 162	[RDMA_NLDEV_SYS_ATTR_NETNS_MODE]	= { .type = NLA_U8 },
 163	[RDMA_NLDEV_SYS_ATTR_COPY_ON_FORK]	= { .type = NLA_U8 },
 164	[RDMA_NLDEV_ATTR_STAT_HWCOUNTER_INDEX]	= { .type = NLA_U32 },
 165	[RDMA_NLDEV_ATTR_STAT_HWCOUNTER_DYNAMIC] = { .type = NLA_U8 },
 166	[RDMA_NLDEV_SYS_ATTR_PRIVILEGED_QKEY_MODE] = { .type = NLA_U8 },
 167};
 168
 169static int put_driver_name_print_type(struct sk_buff *msg, const char *name,
 170				      enum rdma_nldev_print_type print_type)
 171{
 172	if (nla_put_string(msg, RDMA_NLDEV_ATTR_DRIVER_STRING, name))
 173		return -EMSGSIZE;
 174	if (print_type != RDMA_NLDEV_PRINT_TYPE_UNSPEC &&
 175	    nla_put_u8(msg, RDMA_NLDEV_ATTR_DRIVER_PRINT_TYPE, print_type))
 176		return -EMSGSIZE;
 177
 178	return 0;
 179}
 180
 181static int _rdma_nl_put_driver_u32(struct sk_buff *msg, const char *name,
 182				   enum rdma_nldev_print_type print_type,
 183				   u32 value)
 184{
 185	if (put_driver_name_print_type(msg, name, print_type))
 186		return -EMSGSIZE;
 187	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_DRIVER_U32, value))
 188		return -EMSGSIZE;
 189
 190	return 0;
 191}
 192
 193static int _rdma_nl_put_driver_u64(struct sk_buff *msg, const char *name,
 194				   enum rdma_nldev_print_type print_type,
 195				   u64 value)
 196{
 197	if (put_driver_name_print_type(msg, name, print_type))
 198		return -EMSGSIZE;
 199	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_DRIVER_U64, value,
 200			      RDMA_NLDEV_ATTR_PAD))
 201		return -EMSGSIZE;
 202
 203	return 0;
 204}
 205
 206int rdma_nl_put_driver_string(struct sk_buff *msg, const char *name,
 207			      const char *str)
 208{
 209	if (put_driver_name_print_type(msg, name,
 210				       RDMA_NLDEV_PRINT_TYPE_UNSPEC))
 211		return -EMSGSIZE;
 212	if (nla_put_string(msg, RDMA_NLDEV_ATTR_DRIVER_STRING, str))
 213		return -EMSGSIZE;
 214
 215	return 0;
 216}
 217EXPORT_SYMBOL(rdma_nl_put_driver_string);
 218
 219int rdma_nl_put_driver_u32(struct sk_buff *msg, const char *name, u32 value)
 220{
 221	return _rdma_nl_put_driver_u32(msg, name, RDMA_NLDEV_PRINT_TYPE_UNSPEC,
 222				       value);
 223}
 224EXPORT_SYMBOL(rdma_nl_put_driver_u32);
 225
 226int rdma_nl_put_driver_u32_hex(struct sk_buff *msg, const char *name,
 227			       u32 value)
 228{
 229	return _rdma_nl_put_driver_u32(msg, name, RDMA_NLDEV_PRINT_TYPE_HEX,
 230				       value);
 231}
 232EXPORT_SYMBOL(rdma_nl_put_driver_u32_hex);
 233
 234int rdma_nl_put_driver_u64(struct sk_buff *msg, const char *name, u64 value)
 235{
 236	return _rdma_nl_put_driver_u64(msg, name, RDMA_NLDEV_PRINT_TYPE_UNSPEC,
 237				       value);
 238}
 239EXPORT_SYMBOL(rdma_nl_put_driver_u64);
 240
 241int rdma_nl_put_driver_u64_hex(struct sk_buff *msg, const char *name, u64 value)
 242{
 243	return _rdma_nl_put_driver_u64(msg, name, RDMA_NLDEV_PRINT_TYPE_HEX,
 244				       value);
 245}
 246EXPORT_SYMBOL(rdma_nl_put_driver_u64_hex);
 247
 248bool rdma_nl_get_privileged_qkey(void)
 249{
 250	return privileged_qkey || capable(CAP_NET_RAW);
 251}
 252EXPORT_SYMBOL(rdma_nl_get_privileged_qkey);
 253
 254static int fill_nldev_handle(struct sk_buff *msg, struct ib_device *device)
 255{
 256	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_DEV_INDEX, device->index))
 257		return -EMSGSIZE;
 258	if (nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_NAME,
 259			   dev_name(&device->dev)))
 260		return -EMSGSIZE;
 261
 262	return 0;
 263}
 264
 265static int fill_dev_info(struct sk_buff *msg, struct ib_device *device)
 266{
 267	char fw[IB_FW_VERSION_NAME_MAX];
 268	int ret = 0;
 269	u32 port;
 270
 271	if (fill_nldev_handle(msg, device))
 272		return -EMSGSIZE;
 273
 274	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, rdma_end_port(device)))
 275		return -EMSGSIZE;
 276
 277	BUILD_BUG_ON(sizeof(device->attrs.device_cap_flags) != sizeof(u64));
 278	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CAP_FLAGS,
 279			      device->attrs.device_cap_flags,
 280			      RDMA_NLDEV_ATTR_PAD))
 281		return -EMSGSIZE;
 282
 283	ib_get_device_fw_str(device, fw);
 284	/* Device without FW has strlen(fw) = 0 */
 285	if (strlen(fw) && nla_put_string(msg, RDMA_NLDEV_ATTR_FW_VERSION, fw))
 286		return -EMSGSIZE;
 287
 288	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_NODE_GUID,
 289			      be64_to_cpu(device->node_guid),
 290			      RDMA_NLDEV_ATTR_PAD))
 291		return -EMSGSIZE;
 292	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_SYS_IMAGE_GUID,
 293			      be64_to_cpu(device->attrs.sys_image_guid),
 294			      RDMA_NLDEV_ATTR_PAD))
 295		return -EMSGSIZE;
 296	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_DEV_NODE_TYPE, device->node_type))
 297		return -EMSGSIZE;
 298	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_DEV_DIM, device->use_cq_dim))
 299		return -EMSGSIZE;
 300
 301	/*
 302	 * Link type is determined on first port and mlx4 device
 303	 * which can potentially have two different link type for the same
 304	 * IB device is considered as better to be avoided in the future,
 305	 */
 306	port = rdma_start_port(device);
 307	if (rdma_cap_opa_mad(device, port))
 308		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL, "opa");
 309	else if (rdma_protocol_ib(device, port))
 310		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL, "ib");
 311	else if (rdma_protocol_iwarp(device, port))
 312		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL, "iw");
 313	else if (rdma_protocol_roce(device, port))
 314		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL, "roce");
 315	else if (rdma_protocol_usnic(device, port))
 316		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL,
 317				     "usnic");
 318	return ret;
 319}
 320
 321static int fill_port_info(struct sk_buff *msg,
 322			  struct ib_device *device, u32 port,
 323			  const struct net *net)
 324{
 325	struct net_device *netdev = NULL;
 326	struct ib_port_attr attr;
 327	int ret;
 328	u64 cap_flags = 0;
 329
 330	if (fill_nldev_handle(msg, device))
 331		return -EMSGSIZE;
 332
 333	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port))
 334		return -EMSGSIZE;
 335
 336	ret = ib_query_port(device, port, &attr);
 337	if (ret)
 338		return ret;
 339
 340	if (rdma_protocol_ib(device, port)) {
 341		BUILD_BUG_ON((sizeof(attr.port_cap_flags) +
 342				sizeof(attr.port_cap_flags2)) > sizeof(u64));
 343		cap_flags = attr.port_cap_flags |
 344			((u64)attr.port_cap_flags2 << 32);
 345		if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CAP_FLAGS,
 346				      cap_flags, RDMA_NLDEV_ATTR_PAD))
 347			return -EMSGSIZE;
 348		if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_SUBNET_PREFIX,
 349				      attr.subnet_prefix, RDMA_NLDEV_ATTR_PAD))
 350			return -EMSGSIZE;
 351		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_LID, attr.lid))
 352			return -EMSGSIZE;
 353		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_SM_LID, attr.sm_lid))
 354			return -EMSGSIZE;
 355		if (nla_put_u8(msg, RDMA_NLDEV_ATTR_LMC, attr.lmc))
 356			return -EMSGSIZE;
 357	}
 358	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_PORT_STATE, attr.state))
 359		return -EMSGSIZE;
 360	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_PORT_PHYS_STATE, attr.phys_state))
 361		return -EMSGSIZE;
 362
 363	netdev = ib_device_get_netdev(device, port);
 364	if (netdev && net_eq(dev_net(netdev), net)) {
 365		ret = nla_put_u32(msg,
 366				  RDMA_NLDEV_ATTR_NDEV_INDEX, netdev->ifindex);
 367		if (ret)
 368			goto out;
 369		ret = nla_put_string(msg,
 370				     RDMA_NLDEV_ATTR_NDEV_NAME, netdev->name);
 371	}
 372
 373out:
 374	dev_put(netdev);
 
 375	return ret;
 376}
 377
 378static int fill_res_info_entry(struct sk_buff *msg,
 379			       const char *name, u64 curr)
 380{
 381	struct nlattr *entry_attr;
 382
 383	entry_attr = nla_nest_start_noflag(msg,
 384					   RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY);
 385	if (!entry_attr)
 386		return -EMSGSIZE;
 387
 388	if (nla_put_string(msg, RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY_NAME, name))
 389		goto err;
 390	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY_CURR, curr,
 391			      RDMA_NLDEV_ATTR_PAD))
 392		goto err;
 393
 394	nla_nest_end(msg, entry_attr);
 395	return 0;
 396
 397err:
 398	nla_nest_cancel(msg, entry_attr);
 399	return -EMSGSIZE;
 400}
 401
 402static int fill_res_info(struct sk_buff *msg, struct ib_device *device)
 403{
 404	static const char * const names[RDMA_RESTRACK_MAX] = {
 405		[RDMA_RESTRACK_PD] = "pd",
 406		[RDMA_RESTRACK_CQ] = "cq",
 407		[RDMA_RESTRACK_QP] = "qp",
 408		[RDMA_RESTRACK_CM_ID] = "cm_id",
 409		[RDMA_RESTRACK_MR] = "mr",
 410		[RDMA_RESTRACK_CTX] = "ctx",
 411		[RDMA_RESTRACK_SRQ] = "srq",
 412	};
 413
 414	struct nlattr *table_attr;
 415	int ret, i, curr;
 416
 417	if (fill_nldev_handle(msg, device))
 418		return -EMSGSIZE;
 419
 420	table_attr = nla_nest_start_noflag(msg, RDMA_NLDEV_ATTR_RES_SUMMARY);
 421	if (!table_attr)
 422		return -EMSGSIZE;
 423
 424	for (i = 0; i < RDMA_RESTRACK_MAX; i++) {
 425		if (!names[i])
 426			continue;
 427		curr = rdma_restrack_count(device, i);
 428		ret = fill_res_info_entry(msg, names[i], curr);
 429		if (ret)
 430			goto err;
 431	}
 432
 433	nla_nest_end(msg, table_attr);
 434	return 0;
 435
 436err:
 437	nla_nest_cancel(msg, table_attr);
 438	return ret;
 439}
 440
 441static int fill_res_name_pid(struct sk_buff *msg,
 442			     struct rdma_restrack_entry *res)
 443{
 444	int err = 0;
 445
 446	/*
 447	 * For user resources, user is should read /proc/PID/comm to get the
 448	 * name of the task file.
 449	 */
 450	if (rdma_is_kernel_res(res)) {
 451		err = nla_put_string(msg, RDMA_NLDEV_ATTR_RES_KERN_NAME,
 452				     res->kern_name);
 
 453	} else {
 454		pid_t pid;
 
 
 
 
 
 455
 456		pid = task_pid_vnr(res->task);
 457		/*
 458		 * Task is dead and in zombie state.
 459		 * There is no need to print PID anymore.
 460		 */
 461		if (pid)
 462			/*
 463			 * This part is racy, task can be killed and PID will
 464			 * be zero right here but it is ok, next query won't
 465			 * return PID. We don't promise real-time reflection
 466			 * of SW objects.
 467			 */
 468			err = nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PID, pid);
 469	}
 470
 471	return err ? -EMSGSIZE : 0;
 472}
 473
 474static int fill_res_qp_entry_query(struct sk_buff *msg,
 475				   struct rdma_restrack_entry *res,
 476				   struct ib_device *dev,
 477				   struct ib_qp *qp)
 478{
 
 
 
 
 
 
 
 
 
 
 479	struct ib_qp_init_attr qp_init_attr;
 480	struct ib_qp_attr qp_attr;
 481	int ret;
 482
 483	ret = ib_query_qp(qp, &qp_attr, 0, &qp_init_attr);
 484	if (ret)
 485		return ret;
 486
 
 
 
 
 
 
 
 
 
 
 487	if (qp->qp_type == IB_QPT_RC || qp->qp_type == IB_QPT_UC) {
 488		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_RQPN,
 489				qp_attr.dest_qp_num))
 490			goto err;
 491		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_RQ_PSN,
 492				qp_attr.rq_psn))
 493			goto err;
 494	}
 495
 496	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_SQ_PSN, qp_attr.sq_psn))
 497		goto err;
 498
 499	if (qp->qp_type == IB_QPT_RC || qp->qp_type == IB_QPT_UC ||
 500	    qp->qp_type == IB_QPT_XRC_INI || qp->qp_type == IB_QPT_XRC_TGT) {
 501		if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_PATH_MIG_STATE,
 502			       qp_attr.path_mig_state))
 503			goto err;
 504	}
 505	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_TYPE, qp->qp_type))
 506		goto err;
 507	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_STATE, qp_attr.qp_state))
 508		goto err;
 509
 510	if (dev->ops.fill_res_qp_entry)
 511		return dev->ops.fill_res_qp_entry(msg, qp);
 512	return 0;
 513
 514err:	return -EMSGSIZE;
 515}
 516
 517static int fill_res_qp_entry(struct sk_buff *msg, bool has_cap_net_admin,
 518			     struct rdma_restrack_entry *res, uint32_t port)
 519{
 520	struct ib_qp *qp = container_of(res, struct ib_qp, res);
 521	struct ib_device *dev = qp->device;
 522	int ret;
 523
 524	if (port && port != qp->port)
 525		return -EAGAIN;
 526
 527	/* In create_qp() port is not set yet */
 528	if (qp->port && nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, qp->port))
 529		return -EMSGSIZE;
 530
 531	ret = nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qp->qp_num);
 532	if (ret)
 533		return -EMSGSIZE;
 534
 535	if (!rdma_is_kernel_res(res) &&
 536	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PDN, qp->pd->res.id))
 537		return -EMSGSIZE;
 538
 539	ret = fill_res_name_pid(msg, res);
 540	if (ret)
 541		return -EMSGSIZE;
 542
 543	return fill_res_qp_entry_query(msg, res, dev, qp);
 544}
 545
 546static int fill_res_qp_raw_entry(struct sk_buff *msg, bool has_cap_net_admin,
 547				 struct rdma_restrack_entry *res, uint32_t port)
 548{
 549	struct ib_qp *qp = container_of(res, struct ib_qp, res);
 550	struct ib_device *dev = qp->device;
 551
 552	if (port && port != qp->port)
 553		return -EAGAIN;
 554	if (!dev->ops.fill_res_qp_entry_raw)
 555		return -EINVAL;
 556	return dev->ops.fill_res_qp_entry_raw(msg, qp);
 557}
 558
 559static int fill_res_cm_id_entry(struct sk_buff *msg, bool has_cap_net_admin,
 560				struct rdma_restrack_entry *res, uint32_t port)
 561{
 562	struct rdma_id_private *id_priv =
 563				container_of(res, struct rdma_id_private, res);
 564	struct ib_device *dev = id_priv->id.device;
 565	struct rdma_cm_id *cm_id = &id_priv->id;
 566
 567	if (port && port != cm_id->port_num)
 568		return -EAGAIN;
 569
 570	if (cm_id->port_num &&
 571	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, cm_id->port_num))
 572		goto err;
 573
 574	if (id_priv->qp_num) {
 575		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, id_priv->qp_num))
 576			goto err;
 577		if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_TYPE, cm_id->qp_type))
 578			goto err;
 579	}
 580
 581	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PS, cm_id->ps))
 582		goto err;
 583
 584	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_STATE, id_priv->state))
 585		goto err;
 586
 587	if (cm_id->route.addr.src_addr.ss_family &&
 588	    nla_put(msg, RDMA_NLDEV_ATTR_RES_SRC_ADDR,
 589		    sizeof(cm_id->route.addr.src_addr),
 590		    &cm_id->route.addr.src_addr))
 591		goto err;
 592	if (cm_id->route.addr.dst_addr.ss_family &&
 593	    nla_put(msg, RDMA_NLDEV_ATTR_RES_DST_ADDR,
 594		    sizeof(cm_id->route.addr.dst_addr),
 595		    &cm_id->route.addr.dst_addr))
 596		goto err;
 597
 598	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CM_IDN, res->id))
 599		goto err;
 600
 601	if (fill_res_name_pid(msg, res))
 602		goto err;
 603
 604	if (dev->ops.fill_res_cm_id_entry)
 605		return dev->ops.fill_res_cm_id_entry(msg, cm_id);
 
 606	return 0;
 607
 608err: return -EMSGSIZE;
 609}
 610
 611static int fill_res_cq_entry(struct sk_buff *msg, bool has_cap_net_admin,
 612			     struct rdma_restrack_entry *res, uint32_t port)
 613{
 614	struct ib_cq *cq = container_of(res, struct ib_cq, res);
 615	struct ib_device *dev = cq->device;
 616
 617	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CQE, cq->cqe))
 618		return -EMSGSIZE;
 619	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_RES_USECNT,
 620			      atomic_read(&cq->usecnt), RDMA_NLDEV_ATTR_PAD))
 621		return -EMSGSIZE;
 622
 623	/* Poll context is only valid for kernel CQs */
 624	if (rdma_is_kernel_res(res) &&
 625	    nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_POLL_CTX, cq->poll_ctx))
 626		return -EMSGSIZE;
 627
 628	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_DEV_DIM, (cq->dim != NULL)))
 629		return -EMSGSIZE;
 630
 631	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CQN, res->id))
 632		return -EMSGSIZE;
 633	if (!rdma_is_kernel_res(res) &&
 634	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CTXN,
 635			cq->uobject->uevent.uobject.context->res.id))
 636		return -EMSGSIZE;
 637
 638	if (fill_res_name_pid(msg, res))
 639		return -EMSGSIZE;
 640
 641	return (dev->ops.fill_res_cq_entry) ?
 642		dev->ops.fill_res_cq_entry(msg, cq) : 0;
 643}
 644
 645static int fill_res_cq_raw_entry(struct sk_buff *msg, bool has_cap_net_admin,
 646				 struct rdma_restrack_entry *res, uint32_t port)
 647{
 648	struct ib_cq *cq = container_of(res, struct ib_cq, res);
 649	struct ib_device *dev = cq->device;
 650
 651	if (!dev->ops.fill_res_cq_entry_raw)
 652		return -EINVAL;
 653	return dev->ops.fill_res_cq_entry_raw(msg, cq);
 654}
 655
 656static int fill_res_mr_entry(struct sk_buff *msg, bool has_cap_net_admin,
 657			     struct rdma_restrack_entry *res, uint32_t port)
 658{
 659	struct ib_mr *mr = container_of(res, struct ib_mr, res);
 660	struct ib_device *dev = mr->pd->device;
 661
 662	if (has_cap_net_admin) {
 663		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_RKEY, mr->rkey))
 664			return -EMSGSIZE;
 665		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LKEY, mr->lkey))
 666			return -EMSGSIZE;
 667	}
 668
 669	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_RES_MRLEN, mr->length,
 670			      RDMA_NLDEV_ATTR_PAD))
 671		return -EMSGSIZE;
 672
 673	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_MRN, res->id))
 674		return -EMSGSIZE;
 675
 676	if (!rdma_is_kernel_res(res) &&
 677	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PDN, mr->pd->res.id))
 678		return -EMSGSIZE;
 679
 680	if (fill_res_name_pid(msg, res))
 681		return -EMSGSIZE;
 682
 683	return (dev->ops.fill_res_mr_entry) ?
 684		       dev->ops.fill_res_mr_entry(msg, mr) :
 685		       0;
 686}
 687
 688static int fill_res_mr_raw_entry(struct sk_buff *msg, bool has_cap_net_admin,
 689				 struct rdma_restrack_entry *res, uint32_t port)
 690{
 691	struct ib_mr *mr = container_of(res, struct ib_mr, res);
 692	struct ib_device *dev = mr->pd->device;
 693
 694	if (!dev->ops.fill_res_mr_entry_raw)
 695		return -EINVAL;
 696	return dev->ops.fill_res_mr_entry_raw(msg, mr);
 697}
 698
 699static int fill_res_pd_entry(struct sk_buff *msg, bool has_cap_net_admin,
 700			     struct rdma_restrack_entry *res, uint32_t port)
 701{
 702	struct ib_pd *pd = container_of(res, struct ib_pd, res);
 
 703
 704	if (has_cap_net_admin) {
 705		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LOCAL_DMA_LKEY,
 706				pd->local_dma_lkey))
 707			goto err;
 708		if ((pd->flags & IB_PD_UNSAFE_GLOBAL_RKEY) &&
 709		    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_UNSAFE_GLOBAL_RKEY,
 710				pd->unsafe_global_rkey))
 711			goto err;
 712	}
 713	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_RES_USECNT,
 714			      atomic_read(&pd->usecnt), RDMA_NLDEV_ATTR_PAD))
 715		goto err;
 716
 717	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PDN, res->id))
 718		goto err;
 719
 720	if (!rdma_is_kernel_res(res) &&
 721	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CTXN,
 722			pd->uobject->context->res.id))
 723		goto err;
 724
 725	return fill_res_name_pid(msg, res);
 726
 727err:	return -EMSGSIZE;
 728}
 729
 730static int fill_res_ctx_entry(struct sk_buff *msg, bool has_cap_net_admin,
 731			      struct rdma_restrack_entry *res, uint32_t port)
 732{
 733	struct ib_ucontext *ctx = container_of(res, struct ib_ucontext, res);
 734
 735	if (rdma_is_kernel_res(res))
 736		return 0;
 737
 738	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CTXN, ctx->res.id))
 739		return -EMSGSIZE;
 740
 741	return fill_res_name_pid(msg, res);
 742}
 743
 744static int fill_res_range_qp_entry(struct sk_buff *msg, uint32_t min_range,
 745				   uint32_t max_range)
 746{
 747	struct nlattr *entry_attr;
 748
 749	if (!min_range)
 750		return 0;
 751
 752	entry_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_RES_QP_ENTRY);
 753	if (!entry_attr)
 754		return -EMSGSIZE;
 755
 756	if (min_range == max_range) {
 757		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, min_range))
 758			goto err;
 759	} else {
 760		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_MIN_RANGE, min_range))
 761			goto err;
 762		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_MAX_RANGE, max_range))
 763			goto err;
 764	}
 765	nla_nest_end(msg, entry_attr);
 766	return 0;
 767
 768err:
 769	nla_nest_cancel(msg, entry_attr);
 770	return -EMSGSIZE;
 771}
 772
 773static int fill_res_srq_qps(struct sk_buff *msg, struct ib_srq *srq)
 774{
 775	uint32_t min_range = 0, prev = 0;
 776	struct rdma_restrack_entry *res;
 777	struct rdma_restrack_root *rt;
 778	struct nlattr *table_attr;
 779	struct ib_qp *qp = NULL;
 780	unsigned long id = 0;
 781
 782	table_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_RES_QP);
 783	if (!table_attr)
 784		return -EMSGSIZE;
 785
 786	rt = &srq->device->res[RDMA_RESTRACK_QP];
 787	xa_lock(&rt->xa);
 788	xa_for_each(&rt->xa, id, res) {
 789		if (!rdma_restrack_get(res))
 790			continue;
 791
 792		qp = container_of(res, struct ib_qp, res);
 793		if (!qp->srq || (qp->srq->res.id != srq->res.id)) {
 794			rdma_restrack_put(res);
 795			continue;
 796		}
 797
 798		if (qp->qp_num < prev)
 799			/* qp_num should be ascending */
 800			goto err_loop;
 801
 802		if (min_range == 0) {
 803			min_range = qp->qp_num;
 804		} else if (qp->qp_num > (prev + 1)) {
 805			if (fill_res_range_qp_entry(msg, min_range, prev))
 806				goto err_loop;
 807
 808			min_range = qp->qp_num;
 809		}
 810		prev = qp->qp_num;
 811		rdma_restrack_put(res);
 812	}
 813
 814	xa_unlock(&rt->xa);
 815
 816	if (fill_res_range_qp_entry(msg, min_range, prev))
 817		goto err;
 818
 819	nla_nest_end(msg, table_attr);
 820	return 0;
 821
 822err_loop:
 823	rdma_restrack_put(res);
 824	xa_unlock(&rt->xa);
 825err:
 826	nla_nest_cancel(msg, table_attr);
 827	return -EMSGSIZE;
 828}
 829
 830static int fill_res_srq_entry(struct sk_buff *msg, bool has_cap_net_admin,
 831			      struct rdma_restrack_entry *res, uint32_t port)
 832{
 833	struct ib_srq *srq = container_of(res, struct ib_srq, res);
 834	struct ib_device *dev = srq->device;
 835
 836	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_SRQN, srq->res.id))
 837		goto err;
 838
 839	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_TYPE, srq->srq_type))
 840		goto err;
 841
 842	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PDN, srq->pd->res.id))
 843		goto err;
 844
 845	if (ib_srq_has_cq(srq->srq_type)) {
 846		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CQN,
 847				srq->ext.cq->res.id))
 848			goto err;
 849	}
 850
 851	if (fill_res_srq_qps(msg, srq))
 852		goto err;
 853
 854	if (fill_res_name_pid(msg, res))
 855		goto err;
 856
 857	if (dev->ops.fill_res_srq_entry)
 858		return dev->ops.fill_res_srq_entry(msg, srq);
 859
 860	return 0;
 861
 862err:
 863	return -EMSGSIZE;
 864}
 865
 866static int fill_res_srq_raw_entry(struct sk_buff *msg, bool has_cap_net_admin,
 867				 struct rdma_restrack_entry *res, uint32_t port)
 868{
 869	struct ib_srq *srq = container_of(res, struct ib_srq, res);
 870	struct ib_device *dev = srq->device;
 871
 872	if (!dev->ops.fill_res_srq_entry_raw)
 873		return -EINVAL;
 874	return dev->ops.fill_res_srq_entry_raw(msg, srq);
 875}
 876
 877static int fill_stat_counter_mode(struct sk_buff *msg,
 878				  struct rdma_counter *counter)
 879{
 880	struct rdma_counter_mode *m = &counter->mode;
 881
 882	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_MODE, m->mode))
 883		return -EMSGSIZE;
 884
 885	if (m->mode == RDMA_COUNTER_MODE_AUTO) {
 886		if ((m->mask & RDMA_COUNTER_MASK_QP_TYPE) &&
 887		    nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_TYPE, m->param.qp_type))
 888			return -EMSGSIZE;
 889
 890		if ((m->mask & RDMA_COUNTER_MASK_PID) &&
 891		    fill_res_name_pid(msg, &counter->res))
 892			return -EMSGSIZE;
 893	}
 894
 895	return 0;
 896}
 897
 898static int fill_stat_counter_qp_entry(struct sk_buff *msg, u32 qpn)
 899{
 900	struct nlattr *entry_attr;
 901
 902	entry_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_RES_QP_ENTRY);
 903	if (!entry_attr)
 904		return -EMSGSIZE;
 905
 906	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qpn))
 907		goto err;
 908
 909	nla_nest_end(msg, entry_attr);
 910	return 0;
 911
 912err:
 913	nla_nest_cancel(msg, entry_attr);
 914	return -EMSGSIZE;
 915}
 916
 917static int fill_stat_counter_qps(struct sk_buff *msg,
 918				 struct rdma_counter *counter)
 919{
 920	struct rdma_restrack_entry *res;
 921	struct rdma_restrack_root *rt;
 922	struct nlattr *table_attr;
 923	struct ib_qp *qp = NULL;
 924	unsigned long id = 0;
 925	int ret = 0;
 926
 927	table_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_RES_QP);
 928	if (!table_attr)
 929		return -EMSGSIZE;
 930
 931	rt = &counter->device->res[RDMA_RESTRACK_QP];
 932	xa_lock(&rt->xa);
 933	xa_for_each(&rt->xa, id, res) {
 
 
 
 934		qp = container_of(res, struct ib_qp, res);
 
 
 
 935		if (!qp->counter || (qp->counter->id != counter->id))
 936			continue;
 937
 938		ret = fill_stat_counter_qp_entry(msg, qp->qp_num);
 939		if (ret)
 940			goto err;
 941	}
 942
 943	xa_unlock(&rt->xa);
 944	nla_nest_end(msg, table_attr);
 945	return 0;
 946
 947err:
 948	xa_unlock(&rt->xa);
 949	nla_nest_cancel(msg, table_attr);
 950	return ret;
 951}
 952
 953int rdma_nl_stat_hwcounter_entry(struct sk_buff *msg, const char *name,
 954				 u64 value)
 955{
 956	struct nlattr *entry_attr;
 957
 958	entry_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY);
 959	if (!entry_attr)
 960		return -EMSGSIZE;
 961
 962	if (nla_put_string(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_NAME,
 963			   name))
 964		goto err;
 965	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_VALUE,
 966			      value, RDMA_NLDEV_ATTR_PAD))
 967		goto err;
 968
 969	nla_nest_end(msg, entry_attr);
 970	return 0;
 971
 972err:
 973	nla_nest_cancel(msg, entry_attr);
 974	return -EMSGSIZE;
 975}
 976EXPORT_SYMBOL(rdma_nl_stat_hwcounter_entry);
 977
 978static int fill_stat_mr_entry(struct sk_buff *msg, bool has_cap_net_admin,
 979			      struct rdma_restrack_entry *res, uint32_t port)
 980{
 981	struct ib_mr *mr = container_of(res, struct ib_mr, res);
 982	struct ib_device *dev = mr->pd->device;
 983
 984	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_MRN, res->id))
 985		goto err;
 986
 987	if (dev->ops.fill_stat_mr_entry)
 988		return dev->ops.fill_stat_mr_entry(msg, mr);
 989	return 0;
 990
 991err:
 992	return -EMSGSIZE;
 993}
 994
 995static int fill_stat_counter_hwcounters(struct sk_buff *msg,
 996					struct rdma_counter *counter)
 997{
 998	struct rdma_hw_stats *st = counter->stats;
 999	struct nlattr *table_attr;
1000	int i;
1001
1002	table_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTERS);
1003	if (!table_attr)
1004		return -EMSGSIZE;
1005
1006	mutex_lock(&st->lock);
1007	for (i = 0; i < st->num_counters; i++) {
1008		if (test_bit(i, st->is_disabled))
1009			continue;
1010		if (rdma_nl_stat_hwcounter_entry(msg, st->descs[i].name,
1011						 st->value[i]))
1012			goto err;
1013	}
1014	mutex_unlock(&st->lock);
1015
1016	nla_nest_end(msg, table_attr);
1017	return 0;
1018
1019err:
1020	mutex_unlock(&st->lock);
1021	nla_nest_cancel(msg, table_attr);
1022	return -EMSGSIZE;
1023}
1024
1025static int fill_res_counter_entry(struct sk_buff *msg, bool has_cap_net_admin,
1026				  struct rdma_restrack_entry *res,
1027				  uint32_t port)
1028{
1029	struct rdma_counter *counter =
1030		container_of(res, struct rdma_counter, res);
1031
1032	if (port && port != counter->port)
1033		return -EAGAIN;
1034
1035	/* Dump it even query failed */
1036	rdma_counter_query_stats(counter);
1037
1038	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, counter->port) ||
1039	    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_COUNTER_ID, counter->id) ||
 
1040	    fill_stat_counter_mode(msg, counter) ||
1041	    fill_stat_counter_qps(msg, counter) ||
1042	    fill_stat_counter_hwcounters(msg, counter))
1043		return -EMSGSIZE;
1044
1045	return 0;
1046}
1047
1048static int nldev_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1049			  struct netlink_ext_ack *extack)
1050{
1051	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1052	struct ib_device *device;
1053	struct sk_buff *msg;
1054	u32 index;
1055	int err;
1056
1057	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1058				     nldev_policy, extack);
1059	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1060		return -EINVAL;
1061
1062	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1063
1064	device = ib_device_get_by_index(sock_net(skb->sk), index);
1065	if (!device)
1066		return -EINVAL;
1067
1068	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1069	if (!msg) {
1070		err = -ENOMEM;
1071		goto err;
1072	}
1073
1074	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1075			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
1076			0, 0);
1077	if (!nlh) {
1078		err = -EMSGSIZE;
1079		goto err_free;
1080	}
1081
1082	err = fill_dev_info(msg, device);
1083	if (err)
1084		goto err_free;
1085
1086	nlmsg_end(msg, nlh);
1087
1088	ib_device_put(device);
1089	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1090
1091err_free:
1092	nlmsg_free(msg);
1093err:
1094	ib_device_put(device);
1095	return err;
1096}
1097
1098static int nldev_set_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1099			  struct netlink_ext_ack *extack)
1100{
1101	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1102	struct ib_device *device;
1103	u32 index;
1104	int err;
1105
1106	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1107				     nldev_policy, extack);
1108	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1109		return -EINVAL;
1110
1111	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1112	device = ib_device_get_by_index(sock_net(skb->sk), index);
1113	if (!device)
1114		return -EINVAL;
1115
1116	if (tb[RDMA_NLDEV_ATTR_DEV_NAME]) {
1117		char name[IB_DEVICE_NAME_MAX] = {};
1118
1119		nla_strscpy(name, tb[RDMA_NLDEV_ATTR_DEV_NAME],
1120			    IB_DEVICE_NAME_MAX);
1121		if (strlen(name) == 0) {
1122			err = -EINVAL;
1123			goto done;
1124		}
1125		err = ib_device_rename(device, name);
1126		goto done;
1127	}
1128
1129	if (tb[RDMA_NLDEV_NET_NS_FD]) {
1130		u32 ns_fd;
1131
1132		ns_fd = nla_get_u32(tb[RDMA_NLDEV_NET_NS_FD]);
1133		err = ib_device_set_netns_put(skb, device, ns_fd);
1134		goto put_done;
1135	}
1136
1137	if (tb[RDMA_NLDEV_ATTR_DEV_DIM]) {
1138		u8 use_dim;
1139
1140		use_dim = nla_get_u8(tb[RDMA_NLDEV_ATTR_DEV_DIM]);
1141		err = ib_device_set_dim(device,  use_dim);
1142		goto done;
1143	}
1144
1145done:
1146	ib_device_put(device);
1147put_done:
1148	return err;
1149}
1150
1151static int _nldev_get_dumpit(struct ib_device *device,
1152			     struct sk_buff *skb,
1153			     struct netlink_callback *cb,
1154			     unsigned int idx)
1155{
1156	int start = cb->args[0];
1157	struct nlmsghdr *nlh;
1158
1159	if (idx < start)
1160		return 0;
1161
1162	nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
1163			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
1164			0, NLM_F_MULTI);
1165
1166	if (!nlh || fill_dev_info(skb, device)) {
1167		nlmsg_cancel(skb, nlh);
1168		goto out;
1169	}
1170
1171	nlmsg_end(skb, nlh);
1172
1173	idx++;
1174
1175out:	cb->args[0] = idx;
1176	return skb->len;
1177}
1178
1179static int nldev_get_dumpit(struct sk_buff *skb, struct netlink_callback *cb)
1180{
1181	/*
1182	 * There is no need to take lock, because
1183	 * we are relying on ib_core's locking.
1184	 */
1185	return ib_enum_all_devs(_nldev_get_dumpit, skb, cb);
1186}
1187
1188static int nldev_port_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1189			       struct netlink_ext_ack *extack)
1190{
1191	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1192	struct ib_device *device;
1193	struct sk_buff *msg;
1194	u32 index;
1195	u32 port;
1196	int err;
1197
1198	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1199				     nldev_policy, extack);
1200	if (err ||
1201	    !tb[RDMA_NLDEV_ATTR_DEV_INDEX] ||
1202	    !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
1203		return -EINVAL;
1204
1205	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1206	device = ib_device_get_by_index(sock_net(skb->sk), index);
1207	if (!device)
1208		return -EINVAL;
1209
1210	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1211	if (!rdma_is_port_valid(device, port)) {
1212		err = -EINVAL;
1213		goto err;
1214	}
1215
1216	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1217	if (!msg) {
1218		err = -ENOMEM;
1219		goto err;
1220	}
1221
1222	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1223			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
1224			0, 0);
1225	if (!nlh) {
1226		err = -EMSGSIZE;
1227		goto err_free;
1228	}
1229
1230	err = fill_port_info(msg, device, port, sock_net(skb->sk));
1231	if (err)
1232		goto err_free;
1233
1234	nlmsg_end(msg, nlh);
1235	ib_device_put(device);
1236
1237	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1238
1239err_free:
1240	nlmsg_free(msg);
1241err:
1242	ib_device_put(device);
1243	return err;
1244}
1245
1246static int nldev_port_get_dumpit(struct sk_buff *skb,
1247				 struct netlink_callback *cb)
1248{
1249	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1250	struct ib_device *device;
1251	int start = cb->args[0];
1252	struct nlmsghdr *nlh;
1253	u32 idx = 0;
1254	u32 ifindex;
1255	int err;
1256	unsigned int p;
1257
1258	err = nlmsg_parse_deprecated(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1259				     nldev_policy, NULL);
1260	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1261		return -EINVAL;
1262
1263	ifindex = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1264	device = ib_device_get_by_index(sock_net(skb->sk), ifindex);
1265	if (!device)
1266		return -EINVAL;
1267
1268	rdma_for_each_port (device, p) {
1269		/*
1270		 * The dumpit function returns all information from specific
1271		 * index. This specific index is taken from the netlink
1272		 * messages request sent by user and it is available
1273		 * in cb->args[0].
1274		 *
1275		 * Usually, the user doesn't fill this field and it causes
1276		 * to return everything.
1277		 *
1278		 */
1279		if (idx < start) {
1280			idx++;
1281			continue;
1282		}
1283
1284		nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid,
1285				cb->nlh->nlmsg_seq,
1286				RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1287						 RDMA_NLDEV_CMD_PORT_GET),
1288				0, NLM_F_MULTI);
1289
1290		if (!nlh || fill_port_info(skb, device, p, sock_net(skb->sk))) {
1291			nlmsg_cancel(skb, nlh);
1292			goto out;
1293		}
1294		idx++;
1295		nlmsg_end(skb, nlh);
1296	}
1297
1298out:
1299	ib_device_put(device);
1300	cb->args[0] = idx;
1301	return skb->len;
1302}
1303
1304static int nldev_res_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1305			      struct netlink_ext_ack *extack)
1306{
1307	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1308	struct ib_device *device;
1309	struct sk_buff *msg;
1310	u32 index;
1311	int ret;
1312
1313	ret = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1314				     nldev_policy, extack);
1315	if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1316		return -EINVAL;
1317
1318	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1319	device = ib_device_get_by_index(sock_net(skb->sk), index);
1320	if (!device)
1321		return -EINVAL;
1322
1323	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1324	if (!msg) {
1325		ret = -ENOMEM;
1326		goto err;
1327	}
1328
1329	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1330			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_RES_GET),
1331			0, 0);
1332	if (!nlh) {
1333		ret = -EMSGSIZE;
1334		goto err_free;
1335	}
1336
1337	ret = fill_res_info(msg, device);
1338	if (ret)
1339		goto err_free;
1340
1341	nlmsg_end(msg, nlh);
1342	ib_device_put(device);
1343	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1344
1345err_free:
1346	nlmsg_free(msg);
1347err:
1348	ib_device_put(device);
1349	return ret;
1350}
1351
1352static int _nldev_res_get_dumpit(struct ib_device *device,
1353				 struct sk_buff *skb,
1354				 struct netlink_callback *cb,
1355				 unsigned int idx)
1356{
1357	int start = cb->args[0];
1358	struct nlmsghdr *nlh;
1359
1360	if (idx < start)
1361		return 0;
1362
1363	nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
1364			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_RES_GET),
1365			0, NLM_F_MULTI);
1366
1367	if (!nlh || fill_res_info(skb, device)) {
1368		nlmsg_cancel(skb, nlh);
1369		goto out;
1370	}
1371	nlmsg_end(skb, nlh);
1372
1373	idx++;
1374
1375out:
1376	cb->args[0] = idx;
1377	return skb->len;
1378}
1379
1380static int nldev_res_get_dumpit(struct sk_buff *skb,
1381				struct netlink_callback *cb)
1382{
1383	return ib_enum_all_devs(_nldev_res_get_dumpit, skb, cb);
1384}
1385
1386struct nldev_fill_res_entry {
 
 
1387	enum rdma_nldev_attr nldev_attr;
 
1388	u8 flags;
1389	u32 entry;
1390	u32 id;
1391};
1392
1393enum nldev_res_flags {
1394	NLDEV_PER_DEV = 1 << 0,
1395};
1396
1397static const struct nldev_fill_res_entry fill_entries[RDMA_RESTRACK_MAX] = {
1398	[RDMA_RESTRACK_QP] = {
 
 
1399		.nldev_attr = RDMA_NLDEV_ATTR_RES_QP,
1400		.entry = RDMA_NLDEV_ATTR_RES_QP_ENTRY,
1401		.id = RDMA_NLDEV_ATTR_RES_LQPN,
1402	},
1403	[RDMA_RESTRACK_CM_ID] = {
 
 
1404		.nldev_attr = RDMA_NLDEV_ATTR_RES_CM_ID,
1405		.entry = RDMA_NLDEV_ATTR_RES_CM_ID_ENTRY,
1406		.id = RDMA_NLDEV_ATTR_RES_CM_IDN,
1407	},
1408	[RDMA_RESTRACK_CQ] = {
 
 
1409		.nldev_attr = RDMA_NLDEV_ATTR_RES_CQ,
1410		.flags = NLDEV_PER_DEV,
1411		.entry = RDMA_NLDEV_ATTR_RES_CQ_ENTRY,
1412		.id = RDMA_NLDEV_ATTR_RES_CQN,
1413	},
1414	[RDMA_RESTRACK_MR] = {
 
 
1415		.nldev_attr = RDMA_NLDEV_ATTR_RES_MR,
1416		.flags = NLDEV_PER_DEV,
1417		.entry = RDMA_NLDEV_ATTR_RES_MR_ENTRY,
1418		.id = RDMA_NLDEV_ATTR_RES_MRN,
1419	},
1420	[RDMA_RESTRACK_PD] = {
 
 
1421		.nldev_attr = RDMA_NLDEV_ATTR_RES_PD,
1422		.flags = NLDEV_PER_DEV,
1423		.entry = RDMA_NLDEV_ATTR_RES_PD_ENTRY,
1424		.id = RDMA_NLDEV_ATTR_RES_PDN,
1425	},
1426	[RDMA_RESTRACK_COUNTER] = {
 
 
1427		.nldev_attr = RDMA_NLDEV_ATTR_STAT_COUNTER,
1428		.entry = RDMA_NLDEV_ATTR_STAT_COUNTER_ENTRY,
1429		.id = RDMA_NLDEV_ATTR_STAT_COUNTER_ID,
1430	},
1431	[RDMA_RESTRACK_CTX] = {
1432		.nldev_attr = RDMA_NLDEV_ATTR_RES_CTX,
1433		.flags = NLDEV_PER_DEV,
1434		.entry = RDMA_NLDEV_ATTR_RES_CTX_ENTRY,
1435		.id = RDMA_NLDEV_ATTR_RES_CTXN,
1436	},
1437	[RDMA_RESTRACK_SRQ] = {
1438		.nldev_attr = RDMA_NLDEV_ATTR_RES_SRQ,
1439		.flags = NLDEV_PER_DEV,
1440		.entry = RDMA_NLDEV_ATTR_RES_SRQ_ENTRY,
1441		.id = RDMA_NLDEV_ATTR_RES_SRQN,
1442	},
1443
1444};
1445
1446static int res_get_common_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1447			       struct netlink_ext_ack *extack,
1448			       enum rdma_restrack_type res_type,
1449			       res_fill_func_t fill_func)
1450{
1451	const struct nldev_fill_res_entry *fe = &fill_entries[res_type];
1452	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1453	struct rdma_restrack_entry *res;
1454	struct ib_device *device;
1455	u32 index, id, port = 0;
1456	bool has_cap_net_admin;
1457	struct sk_buff *msg;
1458	int ret;
1459
1460	ret = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1461				     nldev_policy, extack);
1462	if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !fe->id || !tb[fe->id])
1463		return -EINVAL;
1464
1465	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1466	device = ib_device_get_by_index(sock_net(skb->sk), index);
1467	if (!device)
1468		return -EINVAL;
1469
1470	if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1471		port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1472		if (!rdma_is_port_valid(device, port)) {
1473			ret = -EINVAL;
1474			goto err;
1475		}
1476	}
1477
1478	if ((port && fe->flags & NLDEV_PER_DEV) ||
1479	    (!port && ~fe->flags & NLDEV_PER_DEV)) {
1480		ret = -EINVAL;
1481		goto err;
1482	}
1483
1484	id = nla_get_u32(tb[fe->id]);
1485	res = rdma_restrack_get_byid(device, res_type, id);
1486	if (IS_ERR(res)) {
1487		ret = PTR_ERR(res);
1488		goto err;
1489	}
1490
 
 
 
 
 
1491	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1492	if (!msg) {
1493		ret = -ENOMEM;
1494		goto err_get;
1495	}
1496
1497	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1498			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1499					 RDMA_NL_GET_OP(nlh->nlmsg_type)),
1500			0, 0);
1501
1502	if (!nlh || fill_nldev_handle(msg, device)) {
1503		ret = -EMSGSIZE;
1504		goto err_free;
1505	}
1506
1507	has_cap_net_admin = netlink_capable(skb, CAP_NET_ADMIN);
1508
1509	ret = fill_func(msg, has_cap_net_admin, res, port);
1510	if (ret)
1511		goto err_free;
1512
1513	rdma_restrack_put(res);
1514	nlmsg_end(msg, nlh);
1515	ib_device_put(device);
1516	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1517
1518err_free:
1519	nlmsg_free(msg);
1520err_get:
1521	rdma_restrack_put(res);
1522err:
1523	ib_device_put(device);
1524	return ret;
1525}
1526
1527static int res_get_common_dumpit(struct sk_buff *skb,
1528				 struct netlink_callback *cb,
1529				 enum rdma_restrack_type res_type,
1530				 res_fill_func_t fill_func)
1531{
1532	const struct nldev_fill_res_entry *fe = &fill_entries[res_type];
1533	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1534	struct rdma_restrack_entry *res;
1535	struct rdma_restrack_root *rt;
1536	int err, ret = 0, idx = 0;
1537	struct nlattr *table_attr;
1538	struct nlattr *entry_attr;
1539	struct ib_device *device;
1540	int start = cb->args[0];
1541	bool has_cap_net_admin;
1542	struct nlmsghdr *nlh;
1543	unsigned long id;
1544	u32 index, port = 0;
1545	bool filled = false;
1546
1547	err = nlmsg_parse_deprecated(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1548				     nldev_policy, NULL);
1549	/*
1550	 * Right now, we are expecting the device index to get res information,
1551	 * but it is possible to extend this code to return all devices in
1552	 * one shot by checking the existence of RDMA_NLDEV_ATTR_DEV_INDEX.
1553	 * if it doesn't exist, we will iterate over all devices.
1554	 *
1555	 * But it is not needed for now.
1556	 */
1557	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1558		return -EINVAL;
1559
1560	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1561	device = ib_device_get_by_index(sock_net(skb->sk), index);
1562	if (!device)
1563		return -EINVAL;
1564
1565	/*
1566	 * If no PORT_INDEX is supplied, we will return all QPs from that device
1567	 */
1568	if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1569		port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1570		if (!rdma_is_port_valid(device, port)) {
1571			ret = -EINVAL;
1572			goto err_index;
1573		}
1574	}
1575
1576	nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
1577			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1578					 RDMA_NL_GET_OP(cb->nlh->nlmsg_type)),
1579			0, NLM_F_MULTI);
1580
1581	if (!nlh || fill_nldev_handle(skb, device)) {
1582		ret = -EMSGSIZE;
1583		goto err;
1584	}
1585
1586	table_attr = nla_nest_start_noflag(skb, fe->nldev_attr);
1587	if (!table_attr) {
1588		ret = -EMSGSIZE;
1589		goto err;
1590	}
1591
1592	has_cap_net_admin = netlink_capable(cb->skb, CAP_NET_ADMIN);
1593
1594	rt = &device->res[res_type];
1595	xa_lock(&rt->xa);
1596	/*
1597	 * FIXME: if the skip ahead is something common this loop should
1598	 * use xas_for_each & xas_pause to optimize, we can have a lot of
1599	 * objects.
1600	 */
1601	xa_for_each(&rt->xa, id, res) {
 
 
 
1602		if (idx < start || !rdma_restrack_get(res))
1603			goto next;
1604
1605		xa_unlock(&rt->xa);
1606
1607		filled = true;
1608
1609		entry_attr = nla_nest_start_noflag(skb, fe->entry);
1610		if (!entry_attr) {
1611			ret = -EMSGSIZE;
1612			rdma_restrack_put(res);
1613			goto msg_full;
1614		}
1615
1616		ret = fill_func(skb, has_cap_net_admin, res, port);
1617
1618		rdma_restrack_put(res);
1619
1620		if (ret) {
1621			nla_nest_cancel(skb, entry_attr);
1622			if (ret == -EMSGSIZE)
1623				goto msg_full;
1624			if (ret == -EAGAIN)
1625				goto again;
1626			goto res_err;
1627		}
1628		nla_nest_end(skb, entry_attr);
1629again:		xa_lock(&rt->xa);
1630next:		idx++;
1631	}
1632	xa_unlock(&rt->xa);
1633
1634msg_full:
1635	nla_nest_end(skb, table_attr);
1636	nlmsg_end(skb, nlh);
1637	cb->args[0] = idx;
1638
1639	/*
1640	 * No more entries to fill, cancel the message and
1641	 * return 0 to mark end of dumpit.
1642	 */
1643	if (!filled)
1644		goto err;
1645
1646	ib_device_put(device);
1647	return skb->len;
1648
1649res_err:
1650	nla_nest_cancel(skb, table_attr);
1651
1652err:
1653	nlmsg_cancel(skb, nlh);
1654
1655err_index:
1656	ib_device_put(device);
1657	return ret;
1658}
1659
1660#define RES_GET_FUNCS(name, type)                                              \
1661	static int nldev_res_get_##name##_dumpit(struct sk_buff *skb,          \
1662						 struct netlink_callback *cb)  \
1663	{                                                                      \
1664		return res_get_common_dumpit(skb, cb, type,                    \
1665					     fill_res_##name##_entry);         \
1666	}                                                                      \
1667	static int nldev_res_get_##name##_doit(struct sk_buff *skb,            \
1668					       struct nlmsghdr *nlh,           \
1669					       struct netlink_ext_ack *extack) \
1670	{                                                                      \
1671		return res_get_common_doit(skb, nlh, extack, type,             \
1672					   fill_res_##name##_entry);           \
1673	}
1674
1675RES_GET_FUNCS(qp, RDMA_RESTRACK_QP);
1676RES_GET_FUNCS(qp_raw, RDMA_RESTRACK_QP);
1677RES_GET_FUNCS(cm_id, RDMA_RESTRACK_CM_ID);
1678RES_GET_FUNCS(cq, RDMA_RESTRACK_CQ);
1679RES_GET_FUNCS(cq_raw, RDMA_RESTRACK_CQ);
1680RES_GET_FUNCS(pd, RDMA_RESTRACK_PD);
1681RES_GET_FUNCS(mr, RDMA_RESTRACK_MR);
1682RES_GET_FUNCS(mr_raw, RDMA_RESTRACK_MR);
1683RES_GET_FUNCS(counter, RDMA_RESTRACK_COUNTER);
1684RES_GET_FUNCS(ctx, RDMA_RESTRACK_CTX);
1685RES_GET_FUNCS(srq, RDMA_RESTRACK_SRQ);
1686RES_GET_FUNCS(srq_raw, RDMA_RESTRACK_SRQ);
1687
1688static LIST_HEAD(link_ops);
1689static DECLARE_RWSEM(link_ops_rwsem);
1690
1691static const struct rdma_link_ops *link_ops_get(const char *type)
1692{
1693	const struct rdma_link_ops *ops;
1694
1695	list_for_each_entry(ops, &link_ops, list) {
1696		if (!strcmp(ops->type, type))
1697			goto out;
1698	}
1699	ops = NULL;
1700out:
1701	return ops;
1702}
1703
1704void rdma_link_register(struct rdma_link_ops *ops)
1705{
1706	down_write(&link_ops_rwsem);
1707	if (WARN_ON_ONCE(link_ops_get(ops->type)))
1708		goto out;
1709	list_add(&ops->list, &link_ops);
1710out:
1711	up_write(&link_ops_rwsem);
1712}
1713EXPORT_SYMBOL(rdma_link_register);
1714
1715void rdma_link_unregister(struct rdma_link_ops *ops)
1716{
1717	down_write(&link_ops_rwsem);
1718	list_del(&ops->list);
1719	up_write(&link_ops_rwsem);
1720}
1721EXPORT_SYMBOL(rdma_link_unregister);
1722
1723static int nldev_newlink(struct sk_buff *skb, struct nlmsghdr *nlh,
1724			  struct netlink_ext_ack *extack)
1725{
1726	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1727	char ibdev_name[IB_DEVICE_NAME_MAX];
1728	const struct rdma_link_ops *ops;
1729	char ndev_name[IFNAMSIZ];
1730	struct net_device *ndev;
1731	char type[IFNAMSIZ];
1732	int err;
1733
1734	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1735				     nldev_policy, extack);
1736	if (err || !tb[RDMA_NLDEV_ATTR_DEV_NAME] ||
1737	    !tb[RDMA_NLDEV_ATTR_LINK_TYPE] || !tb[RDMA_NLDEV_ATTR_NDEV_NAME])
1738		return -EINVAL;
1739
1740	nla_strscpy(ibdev_name, tb[RDMA_NLDEV_ATTR_DEV_NAME],
1741		    sizeof(ibdev_name));
1742	if (strchr(ibdev_name, '%') || strlen(ibdev_name) == 0)
1743		return -EINVAL;
1744
1745	nla_strscpy(type, tb[RDMA_NLDEV_ATTR_LINK_TYPE], sizeof(type));
1746	nla_strscpy(ndev_name, tb[RDMA_NLDEV_ATTR_NDEV_NAME],
1747		    sizeof(ndev_name));
1748
1749	ndev = dev_get_by_name(sock_net(skb->sk), ndev_name);
1750	if (!ndev)
1751		return -ENODEV;
1752
1753	down_read(&link_ops_rwsem);
1754	ops = link_ops_get(type);
1755#ifdef CONFIG_MODULES
1756	if (!ops) {
1757		up_read(&link_ops_rwsem);
1758		request_module("rdma-link-%s", type);
1759		down_read(&link_ops_rwsem);
1760		ops = link_ops_get(type);
1761	}
1762#endif
1763	err = ops ? ops->newlink(ibdev_name, ndev) : -EINVAL;
1764	up_read(&link_ops_rwsem);
1765	dev_put(ndev);
1766
1767	return err;
1768}
1769
1770static int nldev_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
1771			  struct netlink_ext_ack *extack)
1772{
1773	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1774	struct ib_device *device;
1775	u32 index;
1776	int err;
1777
1778	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1779				     nldev_policy, extack);
1780	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1781		return -EINVAL;
1782
1783	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1784	device = ib_device_get_by_index(sock_net(skb->sk), index);
1785	if (!device)
1786		return -EINVAL;
1787
1788	if (!(device->attrs.kernel_cap_flags & IBK_ALLOW_USER_UNREG)) {
1789		ib_device_put(device);
1790		return -EINVAL;
1791	}
1792
1793	ib_unregister_device_and_put(device);
1794	return 0;
1795}
1796
1797static int nldev_get_chardev(struct sk_buff *skb, struct nlmsghdr *nlh,
1798			     struct netlink_ext_ack *extack)
1799{
1800	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1801	char client_name[RDMA_NLDEV_ATTR_CHARDEV_TYPE_SIZE];
1802	struct ib_client_nl_info data = {};
1803	struct ib_device *ibdev = NULL;
1804	struct sk_buff *msg;
1805	u32 index;
1806	int err;
1807
1808	err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1, nldev_policy,
1809			  extack);
1810	if (err || !tb[RDMA_NLDEV_ATTR_CHARDEV_TYPE])
1811		return -EINVAL;
1812
1813	nla_strscpy(client_name, tb[RDMA_NLDEV_ATTR_CHARDEV_TYPE],
1814		    sizeof(client_name));
1815
1816	if (tb[RDMA_NLDEV_ATTR_DEV_INDEX]) {
1817		index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1818		ibdev = ib_device_get_by_index(sock_net(skb->sk), index);
1819		if (!ibdev)
1820			return -EINVAL;
1821
1822		if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1823			data.port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1824			if (!rdma_is_port_valid(ibdev, data.port)) {
1825				err = -EINVAL;
1826				goto out_put;
1827			}
1828		} else {
1829			data.port = -1;
1830		}
1831	} else if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1832		return -EINVAL;
1833	}
1834
1835	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1836	if (!msg) {
1837		err = -ENOMEM;
1838		goto out_put;
1839	}
1840	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1841			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1842					 RDMA_NLDEV_CMD_GET_CHARDEV),
1843			0, 0);
1844	if (!nlh) {
1845		err = -EMSGSIZE;
1846		goto out_nlmsg;
1847	}
1848
1849	data.nl_msg = msg;
1850	err = ib_get_client_nl_info(ibdev, client_name, &data);
1851	if (err)
1852		goto out_nlmsg;
1853
1854	err = nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CHARDEV,
1855				huge_encode_dev(data.cdev->devt),
1856				RDMA_NLDEV_ATTR_PAD);
1857	if (err)
1858		goto out_data;
1859	err = nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CHARDEV_ABI, data.abi,
1860				RDMA_NLDEV_ATTR_PAD);
1861	if (err)
1862		goto out_data;
1863	if (nla_put_string(msg, RDMA_NLDEV_ATTR_CHARDEV_NAME,
1864			   dev_name(data.cdev))) {
1865		err = -EMSGSIZE;
1866		goto out_data;
1867	}
1868
1869	nlmsg_end(msg, nlh);
1870	put_device(data.cdev);
1871	if (ibdev)
1872		ib_device_put(ibdev);
1873	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1874
1875out_data:
1876	put_device(data.cdev);
1877out_nlmsg:
1878	nlmsg_free(msg);
1879out_put:
1880	if (ibdev)
1881		ib_device_put(ibdev);
1882	return err;
1883}
1884
1885static int nldev_sys_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1886			      struct netlink_ext_ack *extack)
1887{
1888	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1889	struct sk_buff *msg;
1890	int err;
1891
1892	err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1893			  nldev_policy, extack);
1894	if (err)
1895		return err;
1896
1897	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1898	if (!msg)
1899		return -ENOMEM;
1900
1901	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1902			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1903					 RDMA_NLDEV_CMD_SYS_GET),
1904			0, 0);
1905	if (!nlh) {
1906		nlmsg_free(msg);
1907		return -EMSGSIZE;
1908	}
1909
1910	err = nla_put_u8(msg, RDMA_NLDEV_SYS_ATTR_NETNS_MODE,
1911			 (u8)ib_devices_shared_netns);
1912	if (err) {
1913		nlmsg_free(msg);
1914		return err;
1915	}
1916
1917	err = nla_put_u8(msg, RDMA_NLDEV_SYS_ATTR_PRIVILEGED_QKEY_MODE,
1918			 (u8)privileged_qkey);
1919	if (err) {
1920		nlmsg_free(msg);
1921		return err;
1922	}
1923	/*
1924	 * Copy-on-fork is supported.
1925	 * See commits:
1926	 * 70e806e4e645 ("mm: Do early cow for pinned pages during fork() for ptes")
1927	 * 4eae4efa2c29 ("hugetlb: do early cow when page pinned on src mm")
1928	 * for more details. Don't backport this without them.
1929	 *
1930	 * Return value ignored on purpose, assume copy-on-fork is not
1931	 * supported in case of failure.
1932	 */
1933	nla_put_u8(msg, RDMA_NLDEV_SYS_ATTR_COPY_ON_FORK, 1);
1934
1935	nlmsg_end(msg, nlh);
1936	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1937}
1938
1939static int nldev_set_sys_set_netns_doit(struct nlattr *tb[])
1940{
1941	u8 enable;
1942	int err;
1943
1944	enable = nla_get_u8(tb[RDMA_NLDEV_SYS_ATTR_NETNS_MODE]);
1945	/* Only 0 and 1 are supported */
1946	if (enable > 1)
1947		return -EINVAL;
1948
1949	err = rdma_compatdev_set(enable);
1950	return err;
1951}
1952
1953static int nldev_set_sys_set_pqkey_doit(struct nlattr *tb[])
1954{
1955	u8 enable;
1956
1957	enable = nla_get_u8(tb[RDMA_NLDEV_SYS_ATTR_PRIVILEGED_QKEY_MODE]);
1958	/* Only 0 and 1 are supported */
1959	if (enable > 1)
1960		return -EINVAL;
1961
1962	privileged_qkey = enable;
1963	return 0;
1964}
1965
1966static int nldev_set_sys_set_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1967				  struct netlink_ext_ack *extack)
1968{
1969	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
 
1970	int err;
1971
1972	err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1973			  nldev_policy, extack);
1974	if (err)
1975		return -EINVAL;
1976
1977	if (tb[RDMA_NLDEV_SYS_ATTR_NETNS_MODE])
1978		return nldev_set_sys_set_netns_doit(tb);
1979
1980	if (tb[RDMA_NLDEV_SYS_ATTR_PRIVILEGED_QKEY_MODE])
1981		return nldev_set_sys_set_pqkey_doit(tb);
1982
1983	return -EINVAL;
1984}
1985
1986
1987static int nldev_stat_set_mode_doit(struct sk_buff *msg,
1988				    struct netlink_ext_ack *extack,
1989				    struct nlattr *tb[],
1990				    struct ib_device *device, u32 port)
1991{
1992	u32 mode, mask = 0, qpn, cntn = 0;
1993	int ret;
1994
1995	/* Currently only counter for QP is supported */
1996	if (!tb[RDMA_NLDEV_ATTR_STAT_RES] ||
1997	    nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES]) != RDMA_NLDEV_ATTR_RES_QP)
1998		return -EINVAL;
1999
2000	mode = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_MODE]);
2001	if (mode == RDMA_COUNTER_MODE_AUTO) {
2002		if (tb[RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK])
2003			mask = nla_get_u32(
2004				tb[RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK]);
2005		return rdma_counter_set_auto_mode(device, port, mask, extack);
2006	}
2007
2008	if (!tb[RDMA_NLDEV_ATTR_RES_LQPN])
2009		return -EINVAL;
2010
2011	qpn = nla_get_u32(tb[RDMA_NLDEV_ATTR_RES_LQPN]);
2012	if (tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]) {
2013		cntn = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]);
2014		ret = rdma_counter_bind_qpn(device, port, qpn, cntn);
2015		if (ret)
2016			return ret;
2017	} else {
2018		ret = rdma_counter_bind_qpn_alloc(device, port, qpn, &cntn);
2019		if (ret)
2020			return ret;
2021	}
2022
2023	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_COUNTER_ID, cntn) ||
2024	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qpn)) {
2025		ret = -EMSGSIZE;
2026		goto err_fill;
2027	}
2028
2029	return 0;
2030
2031err_fill:
2032	rdma_counter_unbind_qpn(device, port, qpn, cntn);
2033	return ret;
2034}
2035
2036static int nldev_stat_set_counter_dynamic_doit(struct nlattr *tb[],
2037					       struct ib_device *device,
2038					       u32 port)
2039{
2040	struct rdma_hw_stats *stats;
2041	struct nlattr *entry_attr;
2042	unsigned long *target;
2043	int rem, i, ret = 0;
2044	u32 index;
2045
2046	stats = ib_get_hw_stats_port(device, port);
2047	if (!stats)
2048		return -EINVAL;
2049
2050	target = kcalloc(BITS_TO_LONGS(stats->num_counters),
2051			 sizeof(*stats->is_disabled), GFP_KERNEL);
2052	if (!target)
2053		return -ENOMEM;
2054
2055	nla_for_each_nested(entry_attr, tb[RDMA_NLDEV_ATTR_STAT_HWCOUNTERS],
2056			    rem) {
2057		index = nla_get_u32(entry_attr);
2058		if ((index >= stats->num_counters) ||
2059		    !(stats->descs[index].flags & IB_STAT_FLAG_OPTIONAL)) {
2060			ret = -EINVAL;
2061			goto out;
2062		}
2063
2064		set_bit(index, target);
2065	}
2066
2067	for (i = 0; i < stats->num_counters; i++) {
2068		if (!(stats->descs[i].flags & IB_STAT_FLAG_OPTIONAL))
2069			continue;
2070
2071		ret = rdma_counter_modify(device, port, i, test_bit(i, target));
2072		if (ret)
2073			goto out;
2074	}
2075
2076out:
2077	kfree(target);
2078	return ret;
2079}
2080
2081static int nldev_stat_set_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
2082			       struct netlink_ext_ack *extack)
2083{
 
2084	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2085	struct ib_device *device;
2086	struct sk_buff *msg;
2087	u32 index, port;
2088	int ret;
2089
2090	ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1, nldev_policy,
2091			  extack);
2092	if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX] ||
2093	    !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
 
 
 
 
 
2094		return -EINVAL;
2095
2096	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2097	device = ib_device_get_by_index(sock_net(skb->sk), index);
2098	if (!device)
2099		return -EINVAL;
2100
2101	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2102	if (!rdma_is_port_valid(device, port)) {
2103		ret = -EINVAL;
2104		goto err_put_device;
2105	}
2106
2107	if (!tb[RDMA_NLDEV_ATTR_STAT_MODE] &&
2108	    !tb[RDMA_NLDEV_ATTR_STAT_HWCOUNTERS]) {
2109		ret = -EINVAL;
2110		goto err_put_device;
2111	}
2112
2113	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2114	if (!msg) {
2115		ret = -ENOMEM;
2116		goto err_put_device;
2117	}
2118	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2119			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
2120					 RDMA_NLDEV_CMD_STAT_SET),
2121			0, 0);
2122	if (!nlh || fill_nldev_handle(msg, device) ||
2123	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port)) {
2124		ret = -EMSGSIZE;
2125		goto err_free_msg;
2126	}
2127
2128	if (tb[RDMA_NLDEV_ATTR_STAT_MODE]) {
2129		ret = nldev_stat_set_mode_doit(msg, extack, tb, device, port);
2130		if (ret)
2131			goto err_free_msg;
2132	}
2133
2134	if (tb[RDMA_NLDEV_ATTR_STAT_HWCOUNTERS]) {
2135		ret = nldev_stat_set_counter_dynamic_doit(tb, device, port);
 
 
 
 
 
 
 
 
 
 
 
2136		if (ret)
2137			goto err_free_msg;
 
 
 
 
 
 
 
 
2138	}
2139
2140	nlmsg_end(msg, nlh);
2141	ib_device_put(device);
2142	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2143
2144err_free_msg:
 
 
2145	nlmsg_free(msg);
2146err_put_device:
2147	ib_device_put(device);
2148	return ret;
2149}
2150
2151static int nldev_stat_del_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
2152			       struct netlink_ext_ack *extack)
2153{
2154	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2155	struct ib_device *device;
2156	struct sk_buff *msg;
2157	u32 index, port, qpn, cntn;
2158	int ret;
2159
2160	ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2161			  nldev_policy, extack);
2162	if (ret || !tb[RDMA_NLDEV_ATTR_STAT_RES] ||
2163	    !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX] ||
2164	    !tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID] ||
2165	    !tb[RDMA_NLDEV_ATTR_RES_LQPN])
2166		return -EINVAL;
2167
2168	if (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES]) != RDMA_NLDEV_ATTR_RES_QP)
2169		return -EINVAL;
2170
2171	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2172	device = ib_device_get_by_index(sock_net(skb->sk), index);
2173	if (!device)
2174		return -EINVAL;
2175
2176	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2177	if (!rdma_is_port_valid(device, port)) {
2178		ret = -EINVAL;
2179		goto err;
2180	}
2181
2182	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2183	if (!msg) {
2184		ret = -ENOMEM;
2185		goto err;
2186	}
2187	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2188			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
2189					 RDMA_NLDEV_CMD_STAT_SET),
2190			0, 0);
2191	if (!nlh) {
2192		ret = -EMSGSIZE;
2193		goto err_fill;
2194	}
2195
2196	cntn = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]);
2197	qpn = nla_get_u32(tb[RDMA_NLDEV_ATTR_RES_LQPN]);
2198	if (fill_nldev_handle(msg, device) ||
2199	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port) ||
2200	    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_COUNTER_ID, cntn) ||
2201	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qpn)) {
2202		ret = -EMSGSIZE;
2203		goto err_fill;
2204	}
2205
2206	ret = rdma_counter_unbind_qpn(device, port, qpn, cntn);
2207	if (ret)
2208		goto err_fill;
2209
2210	nlmsg_end(msg, nlh);
2211	ib_device_put(device);
2212	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2213
2214err_fill:
2215	nlmsg_free(msg);
2216err:
2217	ib_device_put(device);
2218	return ret;
2219}
2220
2221static int stat_get_doit_default_counter(struct sk_buff *skb,
2222					 struct nlmsghdr *nlh,
2223					 struct netlink_ext_ack *extack,
2224					 struct nlattr *tb[])
2225{
2226	struct rdma_hw_stats *stats;
2227	struct nlattr *table_attr;
2228	struct ib_device *device;
2229	int ret, num_cnts, i;
2230	struct sk_buff *msg;
2231	u32 index, port;
2232	u64 v;
2233
2234	if (!tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
2235		return -EINVAL;
2236
2237	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2238	device = ib_device_get_by_index(sock_net(skb->sk), index);
2239	if (!device)
2240		return -EINVAL;
2241
2242	if (!device->ops.alloc_hw_port_stats || !device->ops.get_hw_stats) {
2243		ret = -EINVAL;
2244		goto err;
2245	}
2246
2247	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2248	stats = ib_get_hw_stats_port(device, port);
2249	if (!stats) {
2250		ret = -EINVAL;
2251		goto err;
2252	}
2253
2254	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2255	if (!msg) {
2256		ret = -ENOMEM;
2257		goto err;
2258	}
2259
2260	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2261			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
2262					 RDMA_NLDEV_CMD_STAT_GET),
2263			0, 0);
2264
2265	if (!nlh || fill_nldev_handle(msg, device) ||
2266	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port)) {
2267		ret = -EMSGSIZE;
2268		goto err_msg;
2269	}
2270
 
 
 
 
 
2271	mutex_lock(&stats->lock);
2272
2273	num_cnts = device->ops.get_hw_stats(device, stats, port, 0);
2274	if (num_cnts < 0) {
2275		ret = -EINVAL;
2276		goto err_stats;
2277	}
2278
2279	table_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTERS);
2280	if (!table_attr) {
2281		ret = -EMSGSIZE;
2282		goto err_stats;
2283	}
2284	for (i = 0; i < num_cnts; i++) {
2285		if (test_bit(i, stats->is_disabled))
2286			continue;
2287
2288		v = stats->value[i] +
2289			rdma_counter_get_hwstat_value(device, port, i);
2290		if (rdma_nl_stat_hwcounter_entry(msg,
2291						 stats->descs[i].name, v)) {
2292			ret = -EMSGSIZE;
2293			goto err_table;
2294		}
2295	}
2296	nla_nest_end(msg, table_attr);
2297
2298	mutex_unlock(&stats->lock);
2299	nlmsg_end(msg, nlh);
2300	ib_device_put(device);
2301	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2302
2303err_table:
2304	nla_nest_cancel(msg, table_attr);
2305err_stats:
2306	mutex_unlock(&stats->lock);
2307err_msg:
2308	nlmsg_free(msg);
2309err:
2310	ib_device_put(device);
2311	return ret;
2312}
2313
2314static int stat_get_doit_qp(struct sk_buff *skb, struct nlmsghdr *nlh,
2315			    struct netlink_ext_ack *extack, struct nlattr *tb[])
2316
2317{
2318	static enum rdma_nl_counter_mode mode;
2319	static enum rdma_nl_counter_mask mask;
2320	struct ib_device *device;
2321	struct sk_buff *msg;
2322	u32 index, port;
2323	int ret;
2324
2325	if (tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID])
2326		return nldev_res_get_counter_doit(skb, nlh, extack);
2327
2328	if (!tb[RDMA_NLDEV_ATTR_STAT_MODE] ||
2329	    !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
2330		return -EINVAL;
2331
2332	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2333	device = ib_device_get_by_index(sock_net(skb->sk), index);
2334	if (!device)
2335		return -EINVAL;
2336
2337	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2338	if (!rdma_is_port_valid(device, port)) {
2339		ret = -EINVAL;
2340		goto err;
2341	}
2342
2343	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2344	if (!msg) {
2345		ret = -ENOMEM;
2346		goto err;
2347	}
2348
2349	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2350			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
2351					 RDMA_NLDEV_CMD_STAT_GET),
2352			0, 0);
2353	if (!nlh) {
2354		ret = -EMSGSIZE;
2355		goto err_msg;
2356	}
2357
2358	ret = rdma_counter_get_mode(device, port, &mode, &mask);
2359	if (ret)
2360		goto err_msg;
2361
2362	if (fill_nldev_handle(msg, device) ||
2363	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port) ||
2364	    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_MODE, mode)) {
2365		ret = -EMSGSIZE;
2366		goto err_msg;
2367	}
2368
2369	if ((mode == RDMA_COUNTER_MODE_AUTO) &&
2370	    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK, mask)) {
2371		ret = -EMSGSIZE;
2372		goto err_msg;
2373	}
2374
2375	nlmsg_end(msg, nlh);
2376	ib_device_put(device);
2377	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2378
2379err_msg:
2380	nlmsg_free(msg);
2381err:
2382	ib_device_put(device);
2383	return ret;
2384}
2385
2386static int nldev_stat_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
2387			       struct netlink_ext_ack *extack)
2388{
2389	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2390	int ret;
2391
2392	ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2393			  nldev_policy, extack);
2394	if (ret)
2395		return -EINVAL;
2396
2397	if (!tb[RDMA_NLDEV_ATTR_STAT_RES])
2398		return stat_get_doit_default_counter(skb, nlh, extack, tb);
2399
2400	switch (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES])) {
2401	case RDMA_NLDEV_ATTR_RES_QP:
2402		ret = stat_get_doit_qp(skb, nlh, extack, tb);
2403		break;
2404	case RDMA_NLDEV_ATTR_RES_MR:
2405		ret = res_get_common_doit(skb, nlh, extack, RDMA_RESTRACK_MR,
2406					  fill_stat_mr_entry);
2407		break;
2408	default:
2409		ret = -EINVAL;
2410		break;
2411	}
2412
2413	return ret;
2414}
2415
2416static int nldev_stat_get_dumpit(struct sk_buff *skb,
2417				 struct netlink_callback *cb)
2418{
2419	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2420	int ret;
2421
2422	ret = nlmsg_parse(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2423			  nldev_policy, NULL);
2424	if (ret || !tb[RDMA_NLDEV_ATTR_STAT_RES])
2425		return -EINVAL;
2426
2427	switch (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES])) {
2428	case RDMA_NLDEV_ATTR_RES_QP:
2429		ret = nldev_res_get_counter_dumpit(skb, cb);
2430		break;
2431	case RDMA_NLDEV_ATTR_RES_MR:
2432		ret = res_get_common_dumpit(skb, cb, RDMA_RESTRACK_MR,
2433					    fill_stat_mr_entry);
2434		break;
2435	default:
2436		ret = -EINVAL;
2437		break;
2438	}
2439
2440	return ret;
2441}
2442
2443static int nldev_stat_get_counter_status_doit(struct sk_buff *skb,
2444					      struct nlmsghdr *nlh,
2445					      struct netlink_ext_ack *extack)
2446{
2447	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX], *table, *entry;
2448	struct rdma_hw_stats *stats;
2449	struct ib_device *device;
2450	struct sk_buff *msg;
2451	u32 devid, port;
2452	int ret, i;
2453
2454	ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2455			  nldev_policy, extack);
2456	if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX] ||
2457	    !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
2458		return -EINVAL;
2459
2460	devid = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2461	device = ib_device_get_by_index(sock_net(skb->sk), devid);
2462	if (!device)
2463		return -EINVAL;
2464
2465	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2466	if (!rdma_is_port_valid(device, port)) {
2467		ret = -EINVAL;
2468		goto err;
2469	}
2470
2471	stats = ib_get_hw_stats_port(device, port);
2472	if (!stats) {
2473		ret = -EINVAL;
2474		goto err;
2475	}
2476
2477	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2478	if (!msg) {
2479		ret = -ENOMEM;
2480		goto err;
2481	}
2482
2483	nlh = nlmsg_put(
2484		msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2485		RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_STAT_GET_STATUS),
2486		0, 0);
2487
2488	ret = -EMSGSIZE;
2489	if (!nlh || fill_nldev_handle(msg, device) ||
2490	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port))
2491		goto err_msg;
2492
2493	table = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTERS);
2494	if (!table)
2495		goto err_msg;
2496
2497	mutex_lock(&stats->lock);
2498	for (i = 0; i < stats->num_counters; i++) {
2499		entry = nla_nest_start(msg,
2500				       RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY);
2501		if (!entry)
2502			goto err_msg_table;
2503
2504		if (nla_put_string(msg,
2505				   RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_NAME,
2506				   stats->descs[i].name) ||
2507		    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_INDEX, i))
2508			goto err_msg_entry;
2509
2510		if ((stats->descs[i].flags & IB_STAT_FLAG_OPTIONAL) &&
2511		    (nla_put_u8(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_DYNAMIC,
2512				!test_bit(i, stats->is_disabled))))
2513			goto err_msg_entry;
2514
2515		nla_nest_end(msg, entry);
2516	}
2517	mutex_unlock(&stats->lock);
2518
2519	nla_nest_end(msg, table);
2520	nlmsg_end(msg, nlh);
2521	ib_device_put(device);
2522	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2523
2524err_msg_entry:
2525	nla_nest_cancel(msg, entry);
2526err_msg_table:
2527	mutex_unlock(&stats->lock);
2528	nla_nest_cancel(msg, table);
2529err_msg:
2530	nlmsg_free(msg);
2531err:
2532	ib_device_put(device);
2533	return ret;
2534}
2535
2536static const struct rdma_nl_cbs nldev_cb_table[RDMA_NLDEV_NUM_OPS] = {
2537	[RDMA_NLDEV_CMD_GET] = {
2538		.doit = nldev_get_doit,
2539		.dump = nldev_get_dumpit,
2540	},
2541	[RDMA_NLDEV_CMD_GET_CHARDEV] = {
2542		.doit = nldev_get_chardev,
2543	},
2544	[RDMA_NLDEV_CMD_SET] = {
2545		.doit = nldev_set_doit,
2546		.flags = RDMA_NL_ADMIN_PERM,
2547	},
2548	[RDMA_NLDEV_CMD_NEWLINK] = {
2549		.doit = nldev_newlink,
2550		.flags = RDMA_NL_ADMIN_PERM,
2551	},
2552	[RDMA_NLDEV_CMD_DELLINK] = {
2553		.doit = nldev_dellink,
2554		.flags = RDMA_NL_ADMIN_PERM,
2555	},
2556	[RDMA_NLDEV_CMD_PORT_GET] = {
2557		.doit = nldev_port_get_doit,
2558		.dump = nldev_port_get_dumpit,
2559	},
2560	[RDMA_NLDEV_CMD_RES_GET] = {
2561		.doit = nldev_res_get_doit,
2562		.dump = nldev_res_get_dumpit,
2563	},
2564	[RDMA_NLDEV_CMD_RES_QP_GET] = {
2565		.doit = nldev_res_get_qp_doit,
2566		.dump = nldev_res_get_qp_dumpit,
2567	},
2568	[RDMA_NLDEV_CMD_RES_CM_ID_GET] = {
2569		.doit = nldev_res_get_cm_id_doit,
2570		.dump = nldev_res_get_cm_id_dumpit,
2571	},
2572	[RDMA_NLDEV_CMD_RES_CQ_GET] = {
2573		.doit = nldev_res_get_cq_doit,
2574		.dump = nldev_res_get_cq_dumpit,
2575	},
2576	[RDMA_NLDEV_CMD_RES_MR_GET] = {
2577		.doit = nldev_res_get_mr_doit,
2578		.dump = nldev_res_get_mr_dumpit,
2579	},
2580	[RDMA_NLDEV_CMD_RES_PD_GET] = {
2581		.doit = nldev_res_get_pd_doit,
2582		.dump = nldev_res_get_pd_dumpit,
2583	},
2584	[RDMA_NLDEV_CMD_RES_CTX_GET] = {
2585		.doit = nldev_res_get_ctx_doit,
2586		.dump = nldev_res_get_ctx_dumpit,
2587	},
2588	[RDMA_NLDEV_CMD_RES_SRQ_GET] = {
2589		.doit = nldev_res_get_srq_doit,
2590		.dump = nldev_res_get_srq_dumpit,
2591	},
2592	[RDMA_NLDEV_CMD_SYS_GET] = {
2593		.doit = nldev_sys_get_doit,
2594	},
2595	[RDMA_NLDEV_CMD_SYS_SET] = {
2596		.doit = nldev_set_sys_set_doit,
2597		.flags = RDMA_NL_ADMIN_PERM,
2598	},
2599	[RDMA_NLDEV_CMD_STAT_SET] = {
2600		.doit = nldev_stat_set_doit,
2601		.flags = RDMA_NL_ADMIN_PERM,
2602	},
2603	[RDMA_NLDEV_CMD_STAT_GET] = {
2604		.doit = nldev_stat_get_doit,
2605		.dump = nldev_stat_get_dumpit,
2606	},
2607	[RDMA_NLDEV_CMD_STAT_DEL] = {
2608		.doit = nldev_stat_del_doit,
2609		.flags = RDMA_NL_ADMIN_PERM,
2610	},
2611	[RDMA_NLDEV_CMD_RES_QP_GET_RAW] = {
2612		.doit = nldev_res_get_qp_raw_doit,
2613		.dump = nldev_res_get_qp_raw_dumpit,
2614		.flags = RDMA_NL_ADMIN_PERM,
2615	},
2616	[RDMA_NLDEV_CMD_RES_CQ_GET_RAW] = {
2617		.doit = nldev_res_get_cq_raw_doit,
2618		.dump = nldev_res_get_cq_raw_dumpit,
2619		.flags = RDMA_NL_ADMIN_PERM,
2620	},
2621	[RDMA_NLDEV_CMD_RES_MR_GET_RAW] = {
2622		.doit = nldev_res_get_mr_raw_doit,
2623		.dump = nldev_res_get_mr_raw_dumpit,
2624		.flags = RDMA_NL_ADMIN_PERM,
2625	},
2626	[RDMA_NLDEV_CMD_RES_SRQ_GET_RAW] = {
2627		.doit = nldev_res_get_srq_raw_doit,
2628		.dump = nldev_res_get_srq_raw_dumpit,
2629		.flags = RDMA_NL_ADMIN_PERM,
2630	},
2631	[RDMA_NLDEV_CMD_STAT_GET_STATUS] = {
2632		.doit = nldev_stat_get_counter_status_doit,
2633	},
2634};
2635
2636void __init nldev_init(void)
2637{
2638	rdma_nl_register(RDMA_NL_NLDEV, nldev_cb_table);
2639}
2640
2641void nldev_exit(void)
2642{
2643	rdma_nl_unregister(RDMA_NL_NLDEV);
2644}
2645
2646MODULE_ALIAS_RDMA_NETLINK(RDMA_NL_NLDEV, 5);
v5.4
   1/*
   2 * Copyright (c) 2017 Mellanox Technologies. All rights reserved.
   3 *
   4 * Redistribution and use in source and binary forms, with or without
   5 * modification, are permitted provided that the following conditions are met:
   6 *
   7 * 1. Redistributions of source code must retain the above copyright
   8 *    notice, this list of conditions and the following disclaimer.
   9 * 2. Redistributions in binary form must reproduce the above copyright
  10 *    notice, this list of conditions and the following disclaimer in the
  11 *    documentation and/or other materials provided with the distribution.
  12 * 3. Neither the names of the copyright holders nor the names of its
  13 *    contributors may be used to endorse or promote products derived from
  14 *    this software without specific prior written permission.
  15 *
  16 * Alternatively, this software may be distributed under the terms of the
  17 * GNU General Public License ("GPL") version 2 as published by the Free
  18 * Software Foundation.
  19 *
  20 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  21 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  23 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  24 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  25 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  30 * POSSIBILITY OF SUCH DAMAGE.
  31 */
  32
  33#include <linux/module.h>
  34#include <linux/pid.h>
  35#include <linux/pid_namespace.h>
  36#include <linux/mutex.h>
  37#include <net/netlink.h>
  38#include <rdma/rdma_cm.h>
  39#include <rdma/rdma_netlink.h>
  40
  41#include "core_priv.h"
  42#include "cma_priv.h"
  43#include "restrack.h"
 
 
 
 
 
 
 
 
 
 
 
  44
  45/*
  46 * Sort array elements by the netlink attribute name
  47 */
  48static const struct nla_policy nldev_policy[RDMA_NLDEV_ATTR_MAX] = {
  49	[RDMA_NLDEV_ATTR_CHARDEV]		= { .type = NLA_U64 },
  50	[RDMA_NLDEV_ATTR_CHARDEV_ABI]		= { .type = NLA_U64 },
  51	[RDMA_NLDEV_ATTR_CHARDEV_NAME]		= { .type = NLA_NUL_STRING,
  52					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  53	[RDMA_NLDEV_ATTR_CHARDEV_TYPE]		= { .type = NLA_NUL_STRING,
  54					.len = RDMA_NLDEV_ATTR_CHARDEV_TYPE_SIZE },
  55	[RDMA_NLDEV_ATTR_DEV_DIM]               = { .type = NLA_U8 },
  56	[RDMA_NLDEV_ATTR_DEV_INDEX]		= { .type = NLA_U32 },
  57	[RDMA_NLDEV_ATTR_DEV_NAME]		= { .type = NLA_NUL_STRING,
  58					.len = IB_DEVICE_NAME_MAX },
  59	[RDMA_NLDEV_ATTR_DEV_NODE_TYPE]		= { .type = NLA_U8 },
  60	[RDMA_NLDEV_ATTR_DEV_PROTOCOL]		= { .type = NLA_NUL_STRING,
  61					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  62	[RDMA_NLDEV_ATTR_DRIVER]		= { .type = NLA_NESTED },
  63	[RDMA_NLDEV_ATTR_DRIVER_ENTRY]		= { .type = NLA_NESTED },
  64	[RDMA_NLDEV_ATTR_DRIVER_PRINT_TYPE]	= { .type = NLA_U8 },
  65	[RDMA_NLDEV_ATTR_DRIVER_STRING]		= { .type = NLA_NUL_STRING,
  66					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  67	[RDMA_NLDEV_ATTR_DRIVER_S32]		= { .type = NLA_S32 },
  68	[RDMA_NLDEV_ATTR_DRIVER_S64]		= { .type = NLA_S64 },
  69	[RDMA_NLDEV_ATTR_DRIVER_U32]		= { .type = NLA_U32 },
  70	[RDMA_NLDEV_ATTR_DRIVER_U64]		= { .type = NLA_U64 },
  71	[RDMA_NLDEV_ATTR_FW_VERSION]		= { .type = NLA_NUL_STRING,
  72					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  73	[RDMA_NLDEV_ATTR_LID]			= { .type = NLA_U32 },
  74	[RDMA_NLDEV_ATTR_LINK_TYPE]		= { .type = NLA_NUL_STRING,
  75					.len = IFNAMSIZ },
  76	[RDMA_NLDEV_ATTR_LMC]			= { .type = NLA_U8 },
  77	[RDMA_NLDEV_ATTR_NDEV_INDEX]		= { .type = NLA_U32 },
  78	[RDMA_NLDEV_ATTR_NDEV_NAME]		= { .type = NLA_NUL_STRING,
  79					.len = IFNAMSIZ },
  80	[RDMA_NLDEV_ATTR_NODE_GUID]		= { .type = NLA_U64 },
  81	[RDMA_NLDEV_ATTR_PORT_INDEX]		= { .type = NLA_U32 },
  82	[RDMA_NLDEV_ATTR_PORT_PHYS_STATE]	= { .type = NLA_U8 },
  83	[RDMA_NLDEV_ATTR_PORT_STATE]		= { .type = NLA_U8 },
  84	[RDMA_NLDEV_ATTR_RES_CM_ID]		= { .type = NLA_NESTED },
  85	[RDMA_NLDEV_ATTR_RES_CM_IDN]		= { .type = NLA_U32 },
  86	[RDMA_NLDEV_ATTR_RES_CM_ID_ENTRY]	= { .type = NLA_NESTED },
  87	[RDMA_NLDEV_ATTR_RES_CQ]		= { .type = NLA_NESTED },
  88	[RDMA_NLDEV_ATTR_RES_CQE]		= { .type = NLA_U32 },
  89	[RDMA_NLDEV_ATTR_RES_CQN]		= { .type = NLA_U32 },
  90	[RDMA_NLDEV_ATTR_RES_CQ_ENTRY]		= { .type = NLA_NESTED },
 
  91	[RDMA_NLDEV_ATTR_RES_CTXN]		= { .type = NLA_U32 },
 
  92	[RDMA_NLDEV_ATTR_RES_DST_ADDR]		= {
  93			.len = sizeof(struct __kernel_sockaddr_storage) },
  94	[RDMA_NLDEV_ATTR_RES_IOVA]		= { .type = NLA_U64 },
  95	[RDMA_NLDEV_ATTR_RES_KERN_NAME]		= { .type = NLA_NUL_STRING,
  96					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
  97	[RDMA_NLDEV_ATTR_RES_LKEY]		= { .type = NLA_U32 },
  98	[RDMA_NLDEV_ATTR_RES_LOCAL_DMA_LKEY]	= { .type = NLA_U32 },
  99	[RDMA_NLDEV_ATTR_RES_LQPN]		= { .type = NLA_U32 },
 100	[RDMA_NLDEV_ATTR_RES_MR]		= { .type = NLA_NESTED },
 101	[RDMA_NLDEV_ATTR_RES_MRLEN]		= { .type = NLA_U64 },
 102	[RDMA_NLDEV_ATTR_RES_MRN]		= { .type = NLA_U32 },
 103	[RDMA_NLDEV_ATTR_RES_MR_ENTRY]		= { .type = NLA_NESTED },
 104	[RDMA_NLDEV_ATTR_RES_PATH_MIG_STATE]	= { .type = NLA_U8 },
 105	[RDMA_NLDEV_ATTR_RES_PD]		= { .type = NLA_NESTED },
 106	[RDMA_NLDEV_ATTR_RES_PDN]		= { .type = NLA_U32 },
 107	[RDMA_NLDEV_ATTR_RES_PD_ENTRY]		= { .type = NLA_NESTED },
 108	[RDMA_NLDEV_ATTR_RES_PID]		= { .type = NLA_U32 },
 109	[RDMA_NLDEV_ATTR_RES_POLL_CTX]		= { .type = NLA_U8 },
 110	[RDMA_NLDEV_ATTR_RES_PS]		= { .type = NLA_U32 },
 111	[RDMA_NLDEV_ATTR_RES_QP]		= { .type = NLA_NESTED },
 112	[RDMA_NLDEV_ATTR_RES_QP_ENTRY]		= { .type = NLA_NESTED },
 
 113	[RDMA_NLDEV_ATTR_RES_RKEY]		= { .type = NLA_U32 },
 114	[RDMA_NLDEV_ATTR_RES_RQPN]		= { .type = NLA_U32 },
 115	[RDMA_NLDEV_ATTR_RES_RQ_PSN]		= { .type = NLA_U32 },
 116	[RDMA_NLDEV_ATTR_RES_SQ_PSN]		= { .type = NLA_U32 },
 117	[RDMA_NLDEV_ATTR_RES_SRC_ADDR]		= {
 118			.len = sizeof(struct __kernel_sockaddr_storage) },
 119	[RDMA_NLDEV_ATTR_RES_STATE]		= { .type = NLA_U8 },
 120	[RDMA_NLDEV_ATTR_RES_SUMMARY]		= { .type = NLA_NESTED },
 121	[RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY]	= { .type = NLA_NESTED },
 122	[RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY_CURR]= { .type = NLA_U64 },
 123	[RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY_NAME]= { .type = NLA_NUL_STRING,
 124					.len = RDMA_NLDEV_ATTR_EMPTY_STRING },
 125	[RDMA_NLDEV_ATTR_RES_TYPE]		= { .type = NLA_U8 },
 126	[RDMA_NLDEV_ATTR_RES_UNSAFE_GLOBAL_RKEY]= { .type = NLA_U32 },
 127	[RDMA_NLDEV_ATTR_RES_USECNT]		= { .type = NLA_U64 },
 
 
 
 
 
 128	[RDMA_NLDEV_ATTR_SM_LID]		= { .type = NLA_U32 },
 129	[RDMA_NLDEV_ATTR_SUBNET_PREFIX]		= { .type = NLA_U64 },
 130	[RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK]	= { .type = NLA_U32 },
 131	[RDMA_NLDEV_ATTR_STAT_MODE]		= { .type = NLA_U32 },
 132	[RDMA_NLDEV_ATTR_STAT_RES]		= { .type = NLA_U32 },
 133	[RDMA_NLDEV_ATTR_STAT_COUNTER]		= { .type = NLA_NESTED },
 134	[RDMA_NLDEV_ATTR_STAT_COUNTER_ENTRY]	= { .type = NLA_NESTED },
 135	[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]       = { .type = NLA_U32 },
 136	[RDMA_NLDEV_ATTR_STAT_HWCOUNTERS]       = { .type = NLA_NESTED },
 137	[RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY]  = { .type = NLA_NESTED },
 138	[RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_NAME] = { .type = NLA_NUL_STRING },
 139	[RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_VALUE] = { .type = NLA_U64 },
 140	[RDMA_NLDEV_ATTR_SYS_IMAGE_GUID]	= { .type = NLA_U64 },
 141	[RDMA_NLDEV_ATTR_UVERBS_DRIVER_ID]	= { .type = NLA_U32 },
 142	[RDMA_NLDEV_NET_NS_FD]			= { .type = NLA_U32 },
 143	[RDMA_NLDEV_SYS_ATTR_NETNS_MODE]	= { .type = NLA_U8 },
 
 
 
 
 144};
 145
 146static int put_driver_name_print_type(struct sk_buff *msg, const char *name,
 147				      enum rdma_nldev_print_type print_type)
 148{
 149	if (nla_put_string(msg, RDMA_NLDEV_ATTR_DRIVER_STRING, name))
 150		return -EMSGSIZE;
 151	if (print_type != RDMA_NLDEV_PRINT_TYPE_UNSPEC &&
 152	    nla_put_u8(msg, RDMA_NLDEV_ATTR_DRIVER_PRINT_TYPE, print_type))
 153		return -EMSGSIZE;
 154
 155	return 0;
 156}
 157
 158static int _rdma_nl_put_driver_u32(struct sk_buff *msg, const char *name,
 159				   enum rdma_nldev_print_type print_type,
 160				   u32 value)
 161{
 162	if (put_driver_name_print_type(msg, name, print_type))
 163		return -EMSGSIZE;
 164	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_DRIVER_U32, value))
 165		return -EMSGSIZE;
 166
 167	return 0;
 168}
 169
 170static int _rdma_nl_put_driver_u64(struct sk_buff *msg, const char *name,
 171				   enum rdma_nldev_print_type print_type,
 172				   u64 value)
 173{
 174	if (put_driver_name_print_type(msg, name, print_type))
 175		return -EMSGSIZE;
 176	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_DRIVER_U64, value,
 177			      RDMA_NLDEV_ATTR_PAD))
 178		return -EMSGSIZE;
 179
 180	return 0;
 181}
 182
 
 
 
 
 
 
 
 
 
 
 
 
 
 183int rdma_nl_put_driver_u32(struct sk_buff *msg, const char *name, u32 value)
 184{
 185	return _rdma_nl_put_driver_u32(msg, name, RDMA_NLDEV_PRINT_TYPE_UNSPEC,
 186				       value);
 187}
 188EXPORT_SYMBOL(rdma_nl_put_driver_u32);
 189
 190int rdma_nl_put_driver_u32_hex(struct sk_buff *msg, const char *name,
 191			       u32 value)
 192{
 193	return _rdma_nl_put_driver_u32(msg, name, RDMA_NLDEV_PRINT_TYPE_HEX,
 194				       value);
 195}
 196EXPORT_SYMBOL(rdma_nl_put_driver_u32_hex);
 197
 198int rdma_nl_put_driver_u64(struct sk_buff *msg, const char *name, u64 value)
 199{
 200	return _rdma_nl_put_driver_u64(msg, name, RDMA_NLDEV_PRINT_TYPE_UNSPEC,
 201				       value);
 202}
 203EXPORT_SYMBOL(rdma_nl_put_driver_u64);
 204
 205int rdma_nl_put_driver_u64_hex(struct sk_buff *msg, const char *name, u64 value)
 206{
 207	return _rdma_nl_put_driver_u64(msg, name, RDMA_NLDEV_PRINT_TYPE_HEX,
 208				       value);
 209}
 210EXPORT_SYMBOL(rdma_nl_put_driver_u64_hex);
 211
 
 
 
 
 
 
 212static int fill_nldev_handle(struct sk_buff *msg, struct ib_device *device)
 213{
 214	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_DEV_INDEX, device->index))
 215		return -EMSGSIZE;
 216	if (nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_NAME,
 217			   dev_name(&device->dev)))
 218		return -EMSGSIZE;
 219
 220	return 0;
 221}
 222
 223static int fill_dev_info(struct sk_buff *msg, struct ib_device *device)
 224{
 225	char fw[IB_FW_VERSION_NAME_MAX];
 226	int ret = 0;
 227	u8 port;
 228
 229	if (fill_nldev_handle(msg, device))
 230		return -EMSGSIZE;
 231
 232	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, rdma_end_port(device)))
 233		return -EMSGSIZE;
 234
 235	BUILD_BUG_ON(sizeof(device->attrs.device_cap_flags) != sizeof(u64));
 236	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CAP_FLAGS,
 237			      device->attrs.device_cap_flags,
 238			      RDMA_NLDEV_ATTR_PAD))
 239		return -EMSGSIZE;
 240
 241	ib_get_device_fw_str(device, fw);
 242	/* Device without FW has strlen(fw) = 0 */
 243	if (strlen(fw) && nla_put_string(msg, RDMA_NLDEV_ATTR_FW_VERSION, fw))
 244		return -EMSGSIZE;
 245
 246	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_NODE_GUID,
 247			      be64_to_cpu(device->node_guid),
 248			      RDMA_NLDEV_ATTR_PAD))
 249		return -EMSGSIZE;
 250	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_SYS_IMAGE_GUID,
 251			      be64_to_cpu(device->attrs.sys_image_guid),
 252			      RDMA_NLDEV_ATTR_PAD))
 253		return -EMSGSIZE;
 254	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_DEV_NODE_TYPE, device->node_type))
 255		return -EMSGSIZE;
 256	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_DEV_DIM, device->use_cq_dim))
 257		return -EMSGSIZE;
 258
 259	/*
 260	 * Link type is determined on first port and mlx4 device
 261	 * which can potentially have two different link type for the same
 262	 * IB device is considered as better to be avoided in the future,
 263	 */
 264	port = rdma_start_port(device);
 265	if (rdma_cap_opa_mad(device, port))
 266		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL, "opa");
 267	else if (rdma_protocol_ib(device, port))
 268		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL, "ib");
 269	else if (rdma_protocol_iwarp(device, port))
 270		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL, "iw");
 271	else if (rdma_protocol_roce(device, port))
 272		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL, "roce");
 273	else if (rdma_protocol_usnic(device, port))
 274		ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_PROTOCOL,
 275				     "usnic");
 276	return ret;
 277}
 278
 279static int fill_port_info(struct sk_buff *msg,
 280			  struct ib_device *device, u32 port,
 281			  const struct net *net)
 282{
 283	struct net_device *netdev = NULL;
 284	struct ib_port_attr attr;
 285	int ret;
 286	u64 cap_flags = 0;
 287
 288	if (fill_nldev_handle(msg, device))
 289		return -EMSGSIZE;
 290
 291	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port))
 292		return -EMSGSIZE;
 293
 294	ret = ib_query_port(device, port, &attr);
 295	if (ret)
 296		return ret;
 297
 298	if (rdma_protocol_ib(device, port)) {
 299		BUILD_BUG_ON((sizeof(attr.port_cap_flags) +
 300				sizeof(attr.port_cap_flags2)) > sizeof(u64));
 301		cap_flags = attr.port_cap_flags |
 302			((u64)attr.port_cap_flags2 << 32);
 303		if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CAP_FLAGS,
 304				      cap_flags, RDMA_NLDEV_ATTR_PAD))
 305			return -EMSGSIZE;
 306		if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_SUBNET_PREFIX,
 307				      attr.subnet_prefix, RDMA_NLDEV_ATTR_PAD))
 308			return -EMSGSIZE;
 309		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_LID, attr.lid))
 310			return -EMSGSIZE;
 311		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_SM_LID, attr.sm_lid))
 312			return -EMSGSIZE;
 313		if (nla_put_u8(msg, RDMA_NLDEV_ATTR_LMC, attr.lmc))
 314			return -EMSGSIZE;
 315	}
 316	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_PORT_STATE, attr.state))
 317		return -EMSGSIZE;
 318	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_PORT_PHYS_STATE, attr.phys_state))
 319		return -EMSGSIZE;
 320
 321	netdev = ib_device_get_netdev(device, port);
 322	if (netdev && net_eq(dev_net(netdev), net)) {
 323		ret = nla_put_u32(msg,
 324				  RDMA_NLDEV_ATTR_NDEV_INDEX, netdev->ifindex);
 325		if (ret)
 326			goto out;
 327		ret = nla_put_string(msg,
 328				     RDMA_NLDEV_ATTR_NDEV_NAME, netdev->name);
 329	}
 330
 331out:
 332	if (netdev)
 333		dev_put(netdev);
 334	return ret;
 335}
 336
 337static int fill_res_info_entry(struct sk_buff *msg,
 338			       const char *name, u64 curr)
 339{
 340	struct nlattr *entry_attr;
 341
 342	entry_attr = nla_nest_start_noflag(msg,
 343					   RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY);
 344	if (!entry_attr)
 345		return -EMSGSIZE;
 346
 347	if (nla_put_string(msg, RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY_NAME, name))
 348		goto err;
 349	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_RES_SUMMARY_ENTRY_CURR, curr,
 350			      RDMA_NLDEV_ATTR_PAD))
 351		goto err;
 352
 353	nla_nest_end(msg, entry_attr);
 354	return 0;
 355
 356err:
 357	nla_nest_cancel(msg, entry_attr);
 358	return -EMSGSIZE;
 359}
 360
 361static int fill_res_info(struct sk_buff *msg, struct ib_device *device)
 362{
 363	static const char * const names[RDMA_RESTRACK_MAX] = {
 364		[RDMA_RESTRACK_PD] = "pd",
 365		[RDMA_RESTRACK_CQ] = "cq",
 366		[RDMA_RESTRACK_QP] = "qp",
 367		[RDMA_RESTRACK_CM_ID] = "cm_id",
 368		[RDMA_RESTRACK_MR] = "mr",
 369		[RDMA_RESTRACK_CTX] = "ctx",
 
 370	};
 371
 372	struct nlattr *table_attr;
 373	int ret, i, curr;
 374
 375	if (fill_nldev_handle(msg, device))
 376		return -EMSGSIZE;
 377
 378	table_attr = nla_nest_start_noflag(msg, RDMA_NLDEV_ATTR_RES_SUMMARY);
 379	if (!table_attr)
 380		return -EMSGSIZE;
 381
 382	for (i = 0; i < RDMA_RESTRACK_MAX; i++) {
 383		if (!names[i])
 384			continue;
 385		curr = rdma_restrack_count(device, i);
 386		ret = fill_res_info_entry(msg, names[i], curr);
 387		if (ret)
 388			goto err;
 389	}
 390
 391	nla_nest_end(msg, table_attr);
 392	return 0;
 393
 394err:
 395	nla_nest_cancel(msg, table_attr);
 396	return ret;
 397}
 398
 399static int fill_res_name_pid(struct sk_buff *msg,
 400			     struct rdma_restrack_entry *res)
 401{
 
 
 402	/*
 403	 * For user resources, user is should read /proc/PID/comm to get the
 404	 * name of the task file.
 405	 */
 406	if (rdma_is_kernel_res(res)) {
 407		if (nla_put_string(msg, RDMA_NLDEV_ATTR_RES_KERN_NAME,
 408		    res->kern_name))
 409			return -EMSGSIZE;
 410	} else {
 411		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PID,
 412		    task_pid_vnr(res->task)))
 413			return -EMSGSIZE;
 414	}
 415	return 0;
 416}
 417
 418static bool fill_res_entry(struct ib_device *dev, struct sk_buff *msg,
 419			   struct rdma_restrack_entry *res)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 420{
 421	if (!dev->ops.fill_res_entry)
 422		return false;
 423	return dev->ops.fill_res_entry(msg, res);
 424}
 425
 426static int fill_res_qp_entry(struct sk_buff *msg, bool has_cap_net_admin,
 427			     struct rdma_restrack_entry *res, uint32_t port)
 428{
 429	struct ib_qp *qp = container_of(res, struct ib_qp, res);
 430	struct ib_device *dev = qp->device;
 431	struct ib_qp_init_attr qp_init_attr;
 432	struct ib_qp_attr qp_attr;
 433	int ret;
 434
 435	ret = ib_query_qp(qp, &qp_attr, 0, &qp_init_attr);
 436	if (ret)
 437		return ret;
 438
 439	if (port && port != qp_attr.port_num)
 440		return -EAGAIN;
 441
 442	/* In create_qp() port is not set yet */
 443	if (qp_attr.port_num &&
 444	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, qp_attr.port_num))
 445		goto err;
 446
 447	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qp->qp_num))
 448		goto err;
 449	if (qp->qp_type == IB_QPT_RC || qp->qp_type == IB_QPT_UC) {
 450		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_RQPN,
 451				qp_attr.dest_qp_num))
 452			goto err;
 453		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_RQ_PSN,
 454				qp_attr.rq_psn))
 455			goto err;
 456	}
 457
 458	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_SQ_PSN, qp_attr.sq_psn))
 459		goto err;
 460
 461	if (qp->qp_type == IB_QPT_RC || qp->qp_type == IB_QPT_UC ||
 462	    qp->qp_type == IB_QPT_XRC_INI || qp->qp_type == IB_QPT_XRC_TGT) {
 463		if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_PATH_MIG_STATE,
 464			       qp_attr.path_mig_state))
 465			goto err;
 466	}
 467	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_TYPE, qp->qp_type))
 468		goto err;
 469	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_STATE, qp_attr.qp_state))
 470		goto err;
 471
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 472	if (!rdma_is_kernel_res(res) &&
 473	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PDN, qp->pd->res.id))
 474		goto err;
 475
 476	if (fill_res_name_pid(msg, res))
 477		goto err;
 
 478
 479	if (fill_res_entry(dev, msg, res))
 480		goto err;
 481
 482	return 0;
 
 
 
 
 483
 484err:	return -EMSGSIZE;
 
 
 
 
 485}
 486
 487static int fill_res_cm_id_entry(struct sk_buff *msg, bool has_cap_net_admin,
 488				struct rdma_restrack_entry *res, uint32_t port)
 489{
 490	struct rdma_id_private *id_priv =
 491				container_of(res, struct rdma_id_private, res);
 492	struct ib_device *dev = id_priv->id.device;
 493	struct rdma_cm_id *cm_id = &id_priv->id;
 494
 495	if (port && port != cm_id->port_num)
 496		return 0;
 497
 498	if (cm_id->port_num &&
 499	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, cm_id->port_num))
 500		goto err;
 501
 502	if (id_priv->qp_num) {
 503		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, id_priv->qp_num))
 504			goto err;
 505		if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_TYPE, cm_id->qp_type))
 506			goto err;
 507	}
 508
 509	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PS, cm_id->ps))
 510		goto err;
 511
 512	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_STATE, id_priv->state))
 513		goto err;
 514
 515	if (cm_id->route.addr.src_addr.ss_family &&
 516	    nla_put(msg, RDMA_NLDEV_ATTR_RES_SRC_ADDR,
 517		    sizeof(cm_id->route.addr.src_addr),
 518		    &cm_id->route.addr.src_addr))
 519		goto err;
 520	if (cm_id->route.addr.dst_addr.ss_family &&
 521	    nla_put(msg, RDMA_NLDEV_ATTR_RES_DST_ADDR,
 522		    sizeof(cm_id->route.addr.dst_addr),
 523		    &cm_id->route.addr.dst_addr))
 524		goto err;
 525
 526	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CM_IDN, res->id))
 527		goto err;
 528
 529	if (fill_res_name_pid(msg, res))
 530		goto err;
 531
 532	if (fill_res_entry(dev, msg, res))
 533		goto err;
 534
 535	return 0;
 536
 537err: return -EMSGSIZE;
 538}
 539
 540static int fill_res_cq_entry(struct sk_buff *msg, bool has_cap_net_admin,
 541			     struct rdma_restrack_entry *res, uint32_t port)
 542{
 543	struct ib_cq *cq = container_of(res, struct ib_cq, res);
 544	struct ib_device *dev = cq->device;
 545
 546	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CQE, cq->cqe))
 547		goto err;
 548	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_RES_USECNT,
 549			      atomic_read(&cq->usecnt), RDMA_NLDEV_ATTR_PAD))
 550		goto err;
 551
 552	/* Poll context is only valid for kernel CQs */
 553	if (rdma_is_kernel_res(res) &&
 554	    nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_POLL_CTX, cq->poll_ctx))
 555		goto err;
 556
 557	if (nla_put_u8(msg, RDMA_NLDEV_ATTR_DEV_DIM, (cq->dim != NULL)))
 558		goto err;
 559
 560	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CQN, res->id))
 561		goto err;
 562	if (!rdma_is_kernel_res(res) &&
 563	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CTXN,
 564			cq->uobject->context->res.id))
 565		goto err;
 566
 567	if (fill_res_name_pid(msg, res))
 568		goto err;
 569
 570	if (fill_res_entry(dev, msg, res))
 571		goto err;
 
 572
 573	return 0;
 
 
 
 
 574
 575err:	return -EMSGSIZE;
 
 
 576}
 577
 578static int fill_res_mr_entry(struct sk_buff *msg, bool has_cap_net_admin,
 579			     struct rdma_restrack_entry *res, uint32_t port)
 580{
 581	struct ib_mr *mr = container_of(res, struct ib_mr, res);
 582	struct ib_device *dev = mr->pd->device;
 583
 584	if (has_cap_net_admin) {
 585		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_RKEY, mr->rkey))
 586			goto err;
 587		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LKEY, mr->lkey))
 588			goto err;
 589	}
 590
 591	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_RES_MRLEN, mr->length,
 592			      RDMA_NLDEV_ATTR_PAD))
 593		goto err;
 594
 595	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_MRN, res->id))
 596		goto err;
 597
 598	if (!rdma_is_kernel_res(res) &&
 599	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PDN, mr->pd->res.id))
 600		goto err;
 601
 602	if (fill_res_name_pid(msg, res))
 603		goto err;
 604
 605	if (fill_res_entry(dev, msg, res))
 606		goto err;
 
 
 607
 608	return 0;
 
 
 
 
 609
 610err:	return -EMSGSIZE;
 
 
 611}
 612
 613static int fill_res_pd_entry(struct sk_buff *msg, bool has_cap_net_admin,
 614			     struct rdma_restrack_entry *res, uint32_t port)
 615{
 616	struct ib_pd *pd = container_of(res, struct ib_pd, res);
 617	struct ib_device *dev = pd->device;
 618
 619	if (has_cap_net_admin) {
 620		if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LOCAL_DMA_LKEY,
 621				pd->local_dma_lkey))
 622			goto err;
 623		if ((pd->flags & IB_PD_UNSAFE_GLOBAL_RKEY) &&
 624		    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_UNSAFE_GLOBAL_RKEY,
 625				pd->unsafe_global_rkey))
 626			goto err;
 627	}
 628	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_RES_USECNT,
 629			      atomic_read(&pd->usecnt), RDMA_NLDEV_ATTR_PAD))
 630		goto err;
 631
 632	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_PDN, res->id))
 633		goto err;
 634
 635	if (!rdma_is_kernel_res(res) &&
 636	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_CTXN,
 637			pd->uobject->context->res.id))
 638		goto err;
 639
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 640	if (fill_res_name_pid(msg, res))
 641		goto err;
 642
 643	if (fill_res_entry(dev, msg, res))
 644		goto err;
 645
 646	return 0;
 647
 648err:	return -EMSGSIZE;
 
 
 
 
 
 
 
 
 
 
 
 
 649}
 650
 651static int fill_stat_counter_mode(struct sk_buff *msg,
 652				  struct rdma_counter *counter)
 653{
 654	struct rdma_counter_mode *m = &counter->mode;
 655
 656	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_MODE, m->mode))
 657		return -EMSGSIZE;
 658
 659	if (m->mode == RDMA_COUNTER_MODE_AUTO)
 660		if ((m->mask & RDMA_COUNTER_MASK_QP_TYPE) &&
 661		    nla_put_u8(msg, RDMA_NLDEV_ATTR_RES_TYPE, m->param.qp_type))
 662			return -EMSGSIZE;
 663
 
 
 
 
 
 664	return 0;
 665}
 666
 667static int fill_stat_counter_qp_entry(struct sk_buff *msg, u32 qpn)
 668{
 669	struct nlattr *entry_attr;
 670
 671	entry_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_RES_QP_ENTRY);
 672	if (!entry_attr)
 673		return -EMSGSIZE;
 674
 675	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qpn))
 676		goto err;
 677
 678	nla_nest_end(msg, entry_attr);
 679	return 0;
 680
 681err:
 682	nla_nest_cancel(msg, entry_attr);
 683	return -EMSGSIZE;
 684}
 685
 686static int fill_stat_counter_qps(struct sk_buff *msg,
 687				 struct rdma_counter *counter)
 688{
 689	struct rdma_restrack_entry *res;
 690	struct rdma_restrack_root *rt;
 691	struct nlattr *table_attr;
 692	struct ib_qp *qp = NULL;
 693	unsigned long id = 0;
 694	int ret = 0;
 695
 696	table_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_RES_QP);
 
 
 697
 698	rt = &counter->device->res[RDMA_RESTRACK_QP];
 699	xa_lock(&rt->xa);
 700	xa_for_each(&rt->xa, id, res) {
 701		if (!rdma_is_visible_in_pid_ns(res))
 702			continue;
 703
 704		qp = container_of(res, struct ib_qp, res);
 705		if (qp->qp_type == IB_QPT_RAW_PACKET && !capable(CAP_NET_RAW))
 706			continue;
 707
 708		if (!qp->counter || (qp->counter->id != counter->id))
 709			continue;
 710
 711		ret = fill_stat_counter_qp_entry(msg, qp->qp_num);
 712		if (ret)
 713			goto err;
 714	}
 715
 716	xa_unlock(&rt->xa);
 717	nla_nest_end(msg, table_attr);
 718	return 0;
 719
 720err:
 721	xa_unlock(&rt->xa);
 722	nla_nest_cancel(msg, table_attr);
 723	return ret;
 724}
 725
 726static int fill_stat_hwcounter_entry(struct sk_buff *msg,
 727				     const char *name, u64 value)
 728{
 729	struct nlattr *entry_attr;
 730
 731	entry_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY);
 732	if (!entry_attr)
 733		return -EMSGSIZE;
 734
 735	if (nla_put_string(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_NAME,
 736			   name))
 737		goto err;
 738	if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_VALUE,
 739			      value, RDMA_NLDEV_ATTR_PAD))
 740		goto err;
 741
 742	nla_nest_end(msg, entry_attr);
 743	return 0;
 744
 745err:
 746	nla_nest_cancel(msg, entry_attr);
 747	return -EMSGSIZE;
 748}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 749
 750static int fill_stat_counter_hwcounters(struct sk_buff *msg,
 751					struct rdma_counter *counter)
 752{
 753	struct rdma_hw_stats *st = counter->stats;
 754	struct nlattr *table_attr;
 755	int i;
 756
 757	table_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTERS);
 758	if (!table_attr)
 759		return -EMSGSIZE;
 760
 761	for (i = 0; i < st->num_counters; i++)
 762		if (fill_stat_hwcounter_entry(msg, st->names[i], st->value[i]))
 
 
 
 
 763			goto err;
 
 
 764
 765	nla_nest_end(msg, table_attr);
 766	return 0;
 767
 768err:
 
 769	nla_nest_cancel(msg, table_attr);
 770	return -EMSGSIZE;
 771}
 772
 773static int fill_res_counter_entry(struct sk_buff *msg, bool has_cap_net_admin,
 774				  struct rdma_restrack_entry *res,
 775				  uint32_t port)
 776{
 777	struct rdma_counter *counter =
 778		container_of(res, struct rdma_counter, res);
 779
 780	if (port && port != counter->port)
 781		return -EAGAIN;
 782
 783	/* Dump it even query failed */
 784	rdma_counter_query_stats(counter);
 785
 786	if (nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, counter->port) ||
 787	    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_COUNTER_ID, counter->id) ||
 788	    fill_res_name_pid(msg, &counter->res) ||
 789	    fill_stat_counter_mode(msg, counter) ||
 790	    fill_stat_counter_qps(msg, counter) ||
 791	    fill_stat_counter_hwcounters(msg, counter))
 792		return -EMSGSIZE;
 793
 794	return 0;
 795}
 796
 797static int nldev_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
 798			  struct netlink_ext_ack *extack)
 799{
 800	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
 801	struct ib_device *device;
 802	struct sk_buff *msg;
 803	u32 index;
 804	int err;
 805
 806	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
 807				     nldev_policy, extack);
 808	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
 809		return -EINVAL;
 810
 811	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
 812
 813	device = ib_device_get_by_index(sock_net(skb->sk), index);
 814	if (!device)
 815		return -EINVAL;
 816
 817	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
 818	if (!msg) {
 819		err = -ENOMEM;
 820		goto err;
 821	}
 822
 823	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
 824			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
 825			0, 0);
 
 
 
 
 826
 827	err = fill_dev_info(msg, device);
 828	if (err)
 829		goto err_free;
 830
 831	nlmsg_end(msg, nlh);
 832
 833	ib_device_put(device);
 834	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
 835
 836err_free:
 837	nlmsg_free(msg);
 838err:
 839	ib_device_put(device);
 840	return err;
 841}
 842
 843static int nldev_set_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
 844			  struct netlink_ext_ack *extack)
 845{
 846	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
 847	struct ib_device *device;
 848	u32 index;
 849	int err;
 850
 851	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
 852				     nldev_policy, extack);
 853	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
 854		return -EINVAL;
 855
 856	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
 857	device = ib_device_get_by_index(sock_net(skb->sk), index);
 858	if (!device)
 859		return -EINVAL;
 860
 861	if (tb[RDMA_NLDEV_ATTR_DEV_NAME]) {
 862		char name[IB_DEVICE_NAME_MAX] = {};
 863
 864		nla_strlcpy(name, tb[RDMA_NLDEV_ATTR_DEV_NAME],
 865			    IB_DEVICE_NAME_MAX);
 
 
 
 
 866		err = ib_device_rename(device, name);
 867		goto done;
 868	}
 869
 870	if (tb[RDMA_NLDEV_NET_NS_FD]) {
 871		u32 ns_fd;
 872
 873		ns_fd = nla_get_u32(tb[RDMA_NLDEV_NET_NS_FD]);
 874		err = ib_device_set_netns_put(skb, device, ns_fd);
 875		goto put_done;
 876	}
 877
 878	if (tb[RDMA_NLDEV_ATTR_DEV_DIM]) {
 879		u8 use_dim;
 880
 881		use_dim = nla_get_u8(tb[RDMA_NLDEV_ATTR_DEV_DIM]);
 882		err = ib_device_set_dim(device,  use_dim);
 883		goto done;
 884	}
 885
 886done:
 887	ib_device_put(device);
 888put_done:
 889	return err;
 890}
 891
 892static int _nldev_get_dumpit(struct ib_device *device,
 893			     struct sk_buff *skb,
 894			     struct netlink_callback *cb,
 895			     unsigned int idx)
 896{
 897	int start = cb->args[0];
 898	struct nlmsghdr *nlh;
 899
 900	if (idx < start)
 901		return 0;
 902
 903	nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
 904			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
 905			0, NLM_F_MULTI);
 906
 907	if (fill_dev_info(skb, device)) {
 908		nlmsg_cancel(skb, nlh);
 909		goto out;
 910	}
 911
 912	nlmsg_end(skb, nlh);
 913
 914	idx++;
 915
 916out:	cb->args[0] = idx;
 917	return skb->len;
 918}
 919
 920static int nldev_get_dumpit(struct sk_buff *skb, struct netlink_callback *cb)
 921{
 922	/*
 923	 * There is no need to take lock, because
 924	 * we are relying on ib_core's locking.
 925	 */
 926	return ib_enum_all_devs(_nldev_get_dumpit, skb, cb);
 927}
 928
 929static int nldev_port_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
 930			       struct netlink_ext_ack *extack)
 931{
 932	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
 933	struct ib_device *device;
 934	struct sk_buff *msg;
 935	u32 index;
 936	u32 port;
 937	int err;
 938
 939	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
 940				     nldev_policy, extack);
 941	if (err ||
 942	    !tb[RDMA_NLDEV_ATTR_DEV_INDEX] ||
 943	    !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
 944		return -EINVAL;
 945
 946	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
 947	device = ib_device_get_by_index(sock_net(skb->sk), index);
 948	if (!device)
 949		return -EINVAL;
 950
 951	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
 952	if (!rdma_is_port_valid(device, port)) {
 953		err = -EINVAL;
 954		goto err;
 955	}
 956
 957	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
 958	if (!msg) {
 959		err = -ENOMEM;
 960		goto err;
 961	}
 962
 963	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
 964			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
 965			0, 0);
 
 
 
 
 966
 967	err = fill_port_info(msg, device, port, sock_net(skb->sk));
 968	if (err)
 969		goto err_free;
 970
 971	nlmsg_end(msg, nlh);
 972	ib_device_put(device);
 973
 974	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
 975
 976err_free:
 977	nlmsg_free(msg);
 978err:
 979	ib_device_put(device);
 980	return err;
 981}
 982
 983static int nldev_port_get_dumpit(struct sk_buff *skb,
 984				 struct netlink_callback *cb)
 985{
 986	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
 987	struct ib_device *device;
 988	int start = cb->args[0];
 989	struct nlmsghdr *nlh;
 990	u32 idx = 0;
 991	u32 ifindex;
 992	int err;
 993	unsigned int p;
 994
 995	err = nlmsg_parse_deprecated(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
 996				     nldev_policy, NULL);
 997	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
 998		return -EINVAL;
 999
1000	ifindex = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1001	device = ib_device_get_by_index(sock_net(skb->sk), ifindex);
1002	if (!device)
1003		return -EINVAL;
1004
1005	rdma_for_each_port (device, p) {
1006		/*
1007		 * The dumpit function returns all information from specific
1008		 * index. This specific index is taken from the netlink
1009		 * messages request sent by user and it is available
1010		 * in cb->args[0].
1011		 *
1012		 * Usually, the user doesn't fill this field and it causes
1013		 * to return everything.
1014		 *
1015		 */
1016		if (idx < start) {
1017			idx++;
1018			continue;
1019		}
1020
1021		nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid,
1022				cb->nlh->nlmsg_seq,
1023				RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1024						 RDMA_NLDEV_CMD_PORT_GET),
1025				0, NLM_F_MULTI);
1026
1027		if (fill_port_info(skb, device, p, sock_net(skb->sk))) {
1028			nlmsg_cancel(skb, nlh);
1029			goto out;
1030		}
1031		idx++;
1032		nlmsg_end(skb, nlh);
1033	}
1034
1035out:
1036	ib_device_put(device);
1037	cb->args[0] = idx;
1038	return skb->len;
1039}
1040
1041static int nldev_res_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1042			      struct netlink_ext_ack *extack)
1043{
1044	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1045	struct ib_device *device;
1046	struct sk_buff *msg;
1047	u32 index;
1048	int ret;
1049
1050	ret = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1051				     nldev_policy, extack);
1052	if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1053		return -EINVAL;
1054
1055	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1056	device = ib_device_get_by_index(sock_net(skb->sk), index);
1057	if (!device)
1058		return -EINVAL;
1059
1060	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1061	if (!msg) {
1062		ret = -ENOMEM;
1063		goto err;
1064	}
1065
1066	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1067			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_RES_GET),
1068			0, 0);
 
 
 
 
1069
1070	ret = fill_res_info(msg, device);
1071	if (ret)
1072		goto err_free;
1073
1074	nlmsg_end(msg, nlh);
1075	ib_device_put(device);
1076	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1077
1078err_free:
1079	nlmsg_free(msg);
1080err:
1081	ib_device_put(device);
1082	return ret;
1083}
1084
1085static int _nldev_res_get_dumpit(struct ib_device *device,
1086				 struct sk_buff *skb,
1087				 struct netlink_callback *cb,
1088				 unsigned int idx)
1089{
1090	int start = cb->args[0];
1091	struct nlmsghdr *nlh;
1092
1093	if (idx < start)
1094		return 0;
1095
1096	nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
1097			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_RES_GET),
1098			0, NLM_F_MULTI);
1099
1100	if (fill_res_info(skb, device)) {
1101		nlmsg_cancel(skb, nlh);
1102		goto out;
1103	}
1104	nlmsg_end(skb, nlh);
1105
1106	idx++;
1107
1108out:
1109	cb->args[0] = idx;
1110	return skb->len;
1111}
1112
1113static int nldev_res_get_dumpit(struct sk_buff *skb,
1114				struct netlink_callback *cb)
1115{
1116	return ib_enum_all_devs(_nldev_res_get_dumpit, skb, cb);
1117}
1118
1119struct nldev_fill_res_entry {
1120	int (*fill_res_func)(struct sk_buff *msg, bool has_cap_net_admin,
1121			     struct rdma_restrack_entry *res, u32 port);
1122	enum rdma_nldev_attr nldev_attr;
1123	enum rdma_nldev_command nldev_cmd;
1124	u8 flags;
1125	u32 entry;
1126	u32 id;
1127};
1128
1129enum nldev_res_flags {
1130	NLDEV_PER_DEV = 1 << 0,
1131};
1132
1133static const struct nldev_fill_res_entry fill_entries[RDMA_RESTRACK_MAX] = {
1134	[RDMA_RESTRACK_QP] = {
1135		.fill_res_func = fill_res_qp_entry,
1136		.nldev_cmd = RDMA_NLDEV_CMD_RES_QP_GET,
1137		.nldev_attr = RDMA_NLDEV_ATTR_RES_QP,
1138		.entry = RDMA_NLDEV_ATTR_RES_QP_ENTRY,
1139		.id = RDMA_NLDEV_ATTR_RES_LQPN,
1140	},
1141	[RDMA_RESTRACK_CM_ID] = {
1142		.fill_res_func = fill_res_cm_id_entry,
1143		.nldev_cmd = RDMA_NLDEV_CMD_RES_CM_ID_GET,
1144		.nldev_attr = RDMA_NLDEV_ATTR_RES_CM_ID,
1145		.entry = RDMA_NLDEV_ATTR_RES_CM_ID_ENTRY,
1146		.id = RDMA_NLDEV_ATTR_RES_CM_IDN,
1147	},
1148	[RDMA_RESTRACK_CQ] = {
1149		.fill_res_func = fill_res_cq_entry,
1150		.nldev_cmd = RDMA_NLDEV_CMD_RES_CQ_GET,
1151		.nldev_attr = RDMA_NLDEV_ATTR_RES_CQ,
1152		.flags = NLDEV_PER_DEV,
1153		.entry = RDMA_NLDEV_ATTR_RES_CQ_ENTRY,
1154		.id = RDMA_NLDEV_ATTR_RES_CQN,
1155	},
1156	[RDMA_RESTRACK_MR] = {
1157		.fill_res_func = fill_res_mr_entry,
1158		.nldev_cmd = RDMA_NLDEV_CMD_RES_MR_GET,
1159		.nldev_attr = RDMA_NLDEV_ATTR_RES_MR,
1160		.flags = NLDEV_PER_DEV,
1161		.entry = RDMA_NLDEV_ATTR_RES_MR_ENTRY,
1162		.id = RDMA_NLDEV_ATTR_RES_MRN,
1163	},
1164	[RDMA_RESTRACK_PD] = {
1165		.fill_res_func = fill_res_pd_entry,
1166		.nldev_cmd = RDMA_NLDEV_CMD_RES_PD_GET,
1167		.nldev_attr = RDMA_NLDEV_ATTR_RES_PD,
1168		.flags = NLDEV_PER_DEV,
1169		.entry = RDMA_NLDEV_ATTR_RES_PD_ENTRY,
1170		.id = RDMA_NLDEV_ATTR_RES_PDN,
1171	},
1172	[RDMA_RESTRACK_COUNTER] = {
1173		.fill_res_func = fill_res_counter_entry,
1174		.nldev_cmd = RDMA_NLDEV_CMD_STAT_GET,
1175		.nldev_attr = RDMA_NLDEV_ATTR_STAT_COUNTER,
1176		.entry = RDMA_NLDEV_ATTR_STAT_COUNTER_ENTRY,
1177		.id = RDMA_NLDEV_ATTR_STAT_COUNTER_ID,
1178	},
 
 
 
 
 
 
 
 
 
 
 
 
 
1179};
1180
1181static int res_get_common_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1182			       struct netlink_ext_ack *extack,
1183			       enum rdma_restrack_type res_type)
 
1184{
1185	const struct nldev_fill_res_entry *fe = &fill_entries[res_type];
1186	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1187	struct rdma_restrack_entry *res;
1188	struct ib_device *device;
1189	u32 index, id, port = 0;
1190	bool has_cap_net_admin;
1191	struct sk_buff *msg;
1192	int ret;
1193
1194	ret = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1195				     nldev_policy, extack);
1196	if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !fe->id || !tb[fe->id])
1197		return -EINVAL;
1198
1199	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1200	device = ib_device_get_by_index(sock_net(skb->sk), index);
1201	if (!device)
1202		return -EINVAL;
1203
1204	if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1205		port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1206		if (!rdma_is_port_valid(device, port)) {
1207			ret = -EINVAL;
1208			goto err;
1209		}
1210	}
1211
1212	if ((port && fe->flags & NLDEV_PER_DEV) ||
1213	    (!port && ~fe->flags & NLDEV_PER_DEV)) {
1214		ret = -EINVAL;
1215		goto err;
1216	}
1217
1218	id = nla_get_u32(tb[fe->id]);
1219	res = rdma_restrack_get_byid(device, res_type, id);
1220	if (IS_ERR(res)) {
1221		ret = PTR_ERR(res);
1222		goto err;
1223	}
1224
1225	if (!rdma_is_visible_in_pid_ns(res)) {
1226		ret = -ENOENT;
1227		goto err_get;
1228	}
1229
1230	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1231	if (!msg) {
1232		ret = -ENOMEM;
1233		goto err_get;
1234	}
1235
1236	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1237			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, fe->nldev_cmd),
 
1238			0, 0);
1239
1240	if (fill_nldev_handle(msg, device)) {
1241		ret = -EMSGSIZE;
1242		goto err_free;
1243	}
1244
1245	has_cap_net_admin = netlink_capable(skb, CAP_NET_ADMIN);
1246	ret = fe->fill_res_func(msg, has_cap_net_admin, res, port);
1247	rdma_restrack_put(res);
1248	if (ret)
1249		goto err_free;
1250
 
1251	nlmsg_end(msg, nlh);
1252	ib_device_put(device);
1253	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1254
1255err_free:
1256	nlmsg_free(msg);
1257err_get:
1258	rdma_restrack_put(res);
1259err:
1260	ib_device_put(device);
1261	return ret;
1262}
1263
1264static int res_get_common_dumpit(struct sk_buff *skb,
1265				 struct netlink_callback *cb,
1266				 enum rdma_restrack_type res_type)
 
1267{
1268	const struct nldev_fill_res_entry *fe = &fill_entries[res_type];
1269	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1270	struct rdma_restrack_entry *res;
1271	struct rdma_restrack_root *rt;
1272	int err, ret = 0, idx = 0;
1273	struct nlattr *table_attr;
1274	struct nlattr *entry_attr;
1275	struct ib_device *device;
1276	int start = cb->args[0];
1277	bool has_cap_net_admin;
1278	struct nlmsghdr *nlh;
1279	unsigned long id;
1280	u32 index, port = 0;
1281	bool filled = false;
1282
1283	err = nlmsg_parse_deprecated(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1284				     nldev_policy, NULL);
1285	/*
1286	 * Right now, we are expecting the device index to get res information,
1287	 * but it is possible to extend this code to return all devices in
1288	 * one shot by checking the existence of RDMA_NLDEV_ATTR_DEV_INDEX.
1289	 * if it doesn't exist, we will iterate over all devices.
1290	 *
1291	 * But it is not needed for now.
1292	 */
1293	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1294		return -EINVAL;
1295
1296	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1297	device = ib_device_get_by_index(sock_net(skb->sk), index);
1298	if (!device)
1299		return -EINVAL;
1300
1301	/*
1302	 * If no PORT_INDEX is supplied, we will return all QPs from that device
1303	 */
1304	if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1305		port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1306		if (!rdma_is_port_valid(device, port)) {
1307			ret = -EINVAL;
1308			goto err_index;
1309		}
1310	}
1311
1312	nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
1313			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, fe->nldev_cmd),
 
1314			0, NLM_F_MULTI);
1315
1316	if (fill_nldev_handle(skb, device)) {
1317		ret = -EMSGSIZE;
1318		goto err;
1319	}
1320
1321	table_attr = nla_nest_start_noflag(skb, fe->nldev_attr);
1322	if (!table_attr) {
1323		ret = -EMSGSIZE;
1324		goto err;
1325	}
1326
1327	has_cap_net_admin = netlink_capable(cb->skb, CAP_NET_ADMIN);
1328
1329	rt = &device->res[res_type];
1330	xa_lock(&rt->xa);
1331	/*
1332	 * FIXME: if the skip ahead is something common this loop should
1333	 * use xas_for_each & xas_pause to optimize, we can have a lot of
1334	 * objects.
1335	 */
1336	xa_for_each(&rt->xa, id, res) {
1337		if (!rdma_is_visible_in_pid_ns(res))
1338			continue;
1339
1340		if (idx < start || !rdma_restrack_get(res))
1341			goto next;
1342
1343		xa_unlock(&rt->xa);
1344
1345		filled = true;
1346
1347		entry_attr = nla_nest_start_noflag(skb, fe->entry);
1348		if (!entry_attr) {
1349			ret = -EMSGSIZE;
1350			rdma_restrack_put(res);
1351			goto msg_full;
1352		}
1353
1354		ret = fe->fill_res_func(skb, has_cap_net_admin, res, port);
 
1355		rdma_restrack_put(res);
1356
1357		if (ret) {
1358			nla_nest_cancel(skb, entry_attr);
1359			if (ret == -EMSGSIZE)
1360				goto msg_full;
1361			if (ret == -EAGAIN)
1362				goto again;
1363			goto res_err;
1364		}
1365		nla_nest_end(skb, entry_attr);
1366again:		xa_lock(&rt->xa);
1367next:		idx++;
1368	}
1369	xa_unlock(&rt->xa);
1370
1371msg_full:
1372	nla_nest_end(skb, table_attr);
1373	nlmsg_end(skb, nlh);
1374	cb->args[0] = idx;
1375
1376	/*
1377	 * No more entries to fill, cancel the message and
1378	 * return 0 to mark end of dumpit.
1379	 */
1380	if (!filled)
1381		goto err;
1382
1383	ib_device_put(device);
1384	return skb->len;
1385
1386res_err:
1387	nla_nest_cancel(skb, table_attr);
1388
1389err:
1390	nlmsg_cancel(skb, nlh);
1391
1392err_index:
1393	ib_device_put(device);
1394	return ret;
1395}
1396
1397#define RES_GET_FUNCS(name, type)                                              \
1398	static int nldev_res_get_##name##_dumpit(struct sk_buff *skb,          \
1399						 struct netlink_callback *cb)  \
1400	{                                                                      \
1401		return res_get_common_dumpit(skb, cb, type);                   \
 
1402	}                                                                      \
1403	static int nldev_res_get_##name##_doit(struct sk_buff *skb,            \
1404					       struct nlmsghdr *nlh,           \
1405					       struct netlink_ext_ack *extack) \
1406	{                                                                      \
1407		return res_get_common_doit(skb, nlh, extack, type);            \
 
1408	}
1409
1410RES_GET_FUNCS(qp, RDMA_RESTRACK_QP);
 
1411RES_GET_FUNCS(cm_id, RDMA_RESTRACK_CM_ID);
1412RES_GET_FUNCS(cq, RDMA_RESTRACK_CQ);
 
1413RES_GET_FUNCS(pd, RDMA_RESTRACK_PD);
1414RES_GET_FUNCS(mr, RDMA_RESTRACK_MR);
 
1415RES_GET_FUNCS(counter, RDMA_RESTRACK_COUNTER);
 
 
 
1416
1417static LIST_HEAD(link_ops);
1418static DECLARE_RWSEM(link_ops_rwsem);
1419
1420static const struct rdma_link_ops *link_ops_get(const char *type)
1421{
1422	const struct rdma_link_ops *ops;
1423
1424	list_for_each_entry(ops, &link_ops, list) {
1425		if (!strcmp(ops->type, type))
1426			goto out;
1427	}
1428	ops = NULL;
1429out:
1430	return ops;
1431}
1432
1433void rdma_link_register(struct rdma_link_ops *ops)
1434{
1435	down_write(&link_ops_rwsem);
1436	if (WARN_ON_ONCE(link_ops_get(ops->type)))
1437		goto out;
1438	list_add(&ops->list, &link_ops);
1439out:
1440	up_write(&link_ops_rwsem);
1441}
1442EXPORT_SYMBOL(rdma_link_register);
1443
1444void rdma_link_unregister(struct rdma_link_ops *ops)
1445{
1446	down_write(&link_ops_rwsem);
1447	list_del(&ops->list);
1448	up_write(&link_ops_rwsem);
1449}
1450EXPORT_SYMBOL(rdma_link_unregister);
1451
1452static int nldev_newlink(struct sk_buff *skb, struct nlmsghdr *nlh,
1453			  struct netlink_ext_ack *extack)
1454{
1455	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1456	char ibdev_name[IB_DEVICE_NAME_MAX];
1457	const struct rdma_link_ops *ops;
1458	char ndev_name[IFNAMSIZ];
1459	struct net_device *ndev;
1460	char type[IFNAMSIZ];
1461	int err;
1462
1463	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1464				     nldev_policy, extack);
1465	if (err || !tb[RDMA_NLDEV_ATTR_DEV_NAME] ||
1466	    !tb[RDMA_NLDEV_ATTR_LINK_TYPE] || !tb[RDMA_NLDEV_ATTR_NDEV_NAME])
1467		return -EINVAL;
1468
1469	nla_strlcpy(ibdev_name, tb[RDMA_NLDEV_ATTR_DEV_NAME],
1470		    sizeof(ibdev_name));
1471	if (strchr(ibdev_name, '%'))
1472		return -EINVAL;
1473
1474	nla_strlcpy(type, tb[RDMA_NLDEV_ATTR_LINK_TYPE], sizeof(type));
1475	nla_strlcpy(ndev_name, tb[RDMA_NLDEV_ATTR_NDEV_NAME],
1476		    sizeof(ndev_name));
1477
1478	ndev = dev_get_by_name(sock_net(skb->sk), ndev_name);
1479	if (!ndev)
1480		return -ENODEV;
1481
1482	down_read(&link_ops_rwsem);
1483	ops = link_ops_get(type);
1484#ifdef CONFIG_MODULES
1485	if (!ops) {
1486		up_read(&link_ops_rwsem);
1487		request_module("rdma-link-%s", type);
1488		down_read(&link_ops_rwsem);
1489		ops = link_ops_get(type);
1490	}
1491#endif
1492	err = ops ? ops->newlink(ibdev_name, ndev) : -EINVAL;
1493	up_read(&link_ops_rwsem);
1494	dev_put(ndev);
1495
1496	return err;
1497}
1498
1499static int nldev_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
1500			  struct netlink_ext_ack *extack)
1501{
1502	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1503	struct ib_device *device;
1504	u32 index;
1505	int err;
1506
1507	err = nlmsg_parse_deprecated(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1508				     nldev_policy, extack);
1509	if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1510		return -EINVAL;
1511
1512	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1513	device = ib_device_get_by_index(sock_net(skb->sk), index);
1514	if (!device)
1515		return -EINVAL;
1516
1517	if (!(device->attrs.device_cap_flags & IB_DEVICE_ALLOW_USER_UNREG)) {
1518		ib_device_put(device);
1519		return -EINVAL;
1520	}
1521
1522	ib_unregister_device_and_put(device);
1523	return 0;
1524}
1525
1526static int nldev_get_chardev(struct sk_buff *skb, struct nlmsghdr *nlh,
1527			     struct netlink_ext_ack *extack)
1528{
1529	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1530	char client_name[RDMA_NLDEV_ATTR_CHARDEV_TYPE_SIZE];
1531	struct ib_client_nl_info data = {};
1532	struct ib_device *ibdev = NULL;
1533	struct sk_buff *msg;
1534	u32 index;
1535	int err;
1536
1537	err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1, nldev_policy,
1538			  extack);
1539	if (err || !tb[RDMA_NLDEV_ATTR_CHARDEV_TYPE])
1540		return -EINVAL;
1541
1542	nla_strlcpy(client_name, tb[RDMA_NLDEV_ATTR_CHARDEV_TYPE],
1543		    sizeof(client_name));
1544
1545	if (tb[RDMA_NLDEV_ATTR_DEV_INDEX]) {
1546		index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1547		ibdev = ib_device_get_by_index(sock_net(skb->sk), index);
1548		if (!ibdev)
1549			return -EINVAL;
1550
1551		if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1552			data.port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1553			if (!rdma_is_port_valid(ibdev, data.port)) {
1554				err = -EINVAL;
1555				goto out_put;
1556			}
1557		} else {
1558			data.port = -1;
1559		}
1560	} else if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1561		return -EINVAL;
1562	}
1563
1564	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1565	if (!msg) {
1566		err = -ENOMEM;
1567		goto out_put;
1568	}
1569	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1570			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1571					 RDMA_NLDEV_CMD_GET_CHARDEV),
1572			0, 0);
 
 
 
 
1573
1574	data.nl_msg = msg;
1575	err = ib_get_client_nl_info(ibdev, client_name, &data);
1576	if (err)
1577		goto out_nlmsg;
1578
1579	err = nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CHARDEV,
1580				huge_encode_dev(data.cdev->devt),
1581				RDMA_NLDEV_ATTR_PAD);
1582	if (err)
1583		goto out_data;
1584	err = nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CHARDEV_ABI, data.abi,
1585				RDMA_NLDEV_ATTR_PAD);
1586	if (err)
1587		goto out_data;
1588	if (nla_put_string(msg, RDMA_NLDEV_ATTR_CHARDEV_NAME,
1589			   dev_name(data.cdev))) {
1590		err = -EMSGSIZE;
1591		goto out_data;
1592	}
1593
1594	nlmsg_end(msg, nlh);
1595	put_device(data.cdev);
1596	if (ibdev)
1597		ib_device_put(ibdev);
1598	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1599
1600out_data:
1601	put_device(data.cdev);
1602out_nlmsg:
1603	nlmsg_free(msg);
1604out_put:
1605	if (ibdev)
1606		ib_device_put(ibdev);
1607	return err;
1608}
1609
1610static int nldev_sys_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1611			      struct netlink_ext_ack *extack)
1612{
1613	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1614	struct sk_buff *msg;
1615	int err;
1616
1617	err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1618			  nldev_policy, extack);
1619	if (err)
1620		return err;
1621
1622	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1623	if (!msg)
1624		return -ENOMEM;
1625
1626	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1627			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1628					 RDMA_NLDEV_CMD_SYS_GET),
1629			0, 0);
 
 
 
 
1630
1631	err = nla_put_u8(msg, RDMA_NLDEV_SYS_ATTR_NETNS_MODE,
1632			 (u8)ib_devices_shared_netns);
1633	if (err) {
1634		nlmsg_free(msg);
1635		return err;
1636	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1637	nlmsg_end(msg, nlh);
1638	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1639}
1640
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1641static int nldev_set_sys_set_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1642				  struct netlink_ext_ack *extack)
1643{
1644	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1645	u8 enable;
1646	int err;
1647
1648	err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1649			  nldev_policy, extack);
1650	if (err || !tb[RDMA_NLDEV_SYS_ATTR_NETNS_MODE])
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1651		return -EINVAL;
1652
1653	enable = nla_get_u8(tb[RDMA_NLDEV_SYS_ATTR_NETNS_MODE]);
1654	/* Only 0 and 1 are supported */
1655	if (enable > 1)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1656		return -EINVAL;
1657
1658	err = rdma_compatdev_set(enable);
1659	return err;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1660}
1661
1662static int nldev_stat_set_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1663			       struct netlink_ext_ack *extack)
1664{
1665	u32 index, port, mode, mask = 0, qpn, cntn = 0;
1666	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1667	struct ib_device *device;
1668	struct sk_buff *msg;
 
1669	int ret;
1670
1671	ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1672			  nldev_policy, extack);
1673	/* Currently only counter for QP is supported */
1674	if (ret || !tb[RDMA_NLDEV_ATTR_STAT_RES] ||
1675	    !tb[RDMA_NLDEV_ATTR_DEV_INDEX] ||
1676	    !tb[RDMA_NLDEV_ATTR_PORT_INDEX] || !tb[RDMA_NLDEV_ATTR_STAT_MODE])
1677		return -EINVAL;
1678
1679	if (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES]) != RDMA_NLDEV_ATTR_RES_QP)
1680		return -EINVAL;
1681
1682	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1683	device = ib_device_get_by_index(sock_net(skb->sk), index);
1684	if (!device)
1685		return -EINVAL;
1686
1687	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1688	if (!rdma_is_port_valid(device, port)) {
1689		ret = -EINVAL;
1690		goto err;
 
 
 
 
 
 
1691	}
1692
1693	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1694	if (!msg) {
1695		ret = -ENOMEM;
1696		goto err;
1697	}
1698	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1699			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1700					 RDMA_NLDEV_CMD_STAT_SET),
1701			0, 0);
 
 
 
 
 
1702
1703	mode = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_MODE]);
1704	if (mode == RDMA_COUNTER_MODE_AUTO) {
1705		if (tb[RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK])
1706			mask = nla_get_u32(
1707				tb[RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK]);
1708
1709		ret = rdma_counter_set_auto_mode(device, port,
1710						 mask ? true : false, mask);
1711		if (ret)
1712			goto err_msg;
1713	} else {
1714		qpn = nla_get_u32(tb[RDMA_NLDEV_ATTR_RES_LQPN]);
1715		if (tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]) {
1716			cntn = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]);
1717			ret = rdma_counter_bind_qpn(device, port, qpn, cntn);
1718		} else {
1719			ret = rdma_counter_bind_qpn_alloc(device, port,
1720							  qpn, &cntn);
1721		}
1722		if (ret)
1723			goto err_msg;
1724
1725		if (fill_nldev_handle(msg, device) ||
1726		    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port) ||
1727		    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_COUNTER_ID, cntn) ||
1728		    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qpn)) {
1729			ret = -EMSGSIZE;
1730			goto err_fill;
1731		}
1732	}
1733
1734	nlmsg_end(msg, nlh);
1735	ib_device_put(device);
1736	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1737
1738err_fill:
1739	rdma_counter_unbind_qpn(device, port, qpn, cntn);
1740err_msg:
1741	nlmsg_free(msg);
1742err:
1743	ib_device_put(device);
1744	return ret;
1745}
1746
1747static int nldev_stat_del_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1748			       struct netlink_ext_ack *extack)
1749{
1750	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1751	struct ib_device *device;
1752	struct sk_buff *msg;
1753	u32 index, port, qpn, cntn;
1754	int ret;
1755
1756	ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1757			  nldev_policy, extack);
1758	if (ret || !tb[RDMA_NLDEV_ATTR_STAT_RES] ||
1759	    !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX] ||
1760	    !tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID] ||
1761	    !tb[RDMA_NLDEV_ATTR_RES_LQPN])
1762		return -EINVAL;
1763
1764	if (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES]) != RDMA_NLDEV_ATTR_RES_QP)
1765		return -EINVAL;
1766
1767	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1768	device = ib_device_get_by_index(sock_net(skb->sk), index);
1769	if (!device)
1770		return -EINVAL;
1771
1772	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1773	if (!rdma_is_port_valid(device, port)) {
1774		ret = -EINVAL;
1775		goto err;
1776	}
1777
1778	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1779	if (!msg) {
1780		ret = -ENOMEM;
1781		goto err;
1782	}
1783	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1784			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1785					 RDMA_NLDEV_CMD_STAT_SET),
1786			0, 0);
 
 
 
 
1787
1788	cntn = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]);
1789	qpn = nla_get_u32(tb[RDMA_NLDEV_ATTR_RES_LQPN]);
1790	if (fill_nldev_handle(msg, device) ||
1791	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port) ||
1792	    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_COUNTER_ID, cntn) ||
1793	    nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qpn)) {
1794		ret = -EMSGSIZE;
1795		goto err_fill;
1796	}
1797
1798	ret = rdma_counter_unbind_qpn(device, port, qpn, cntn);
1799	if (ret)
1800		goto err_fill;
1801
1802	nlmsg_end(msg, nlh);
1803	ib_device_put(device);
1804	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1805
1806err_fill:
1807	nlmsg_free(msg);
1808err:
1809	ib_device_put(device);
1810	return ret;
1811}
1812
1813static int stat_get_doit_default_counter(struct sk_buff *skb,
1814					 struct nlmsghdr *nlh,
1815					 struct netlink_ext_ack *extack,
1816					 struct nlattr *tb[])
1817{
1818	struct rdma_hw_stats *stats;
1819	struct nlattr *table_attr;
1820	struct ib_device *device;
1821	int ret, num_cnts, i;
1822	struct sk_buff *msg;
1823	u32 index, port;
1824	u64 v;
1825
1826	if (!tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
1827		return -EINVAL;
1828
1829	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1830	device = ib_device_get_by_index(sock_net(skb->sk), index);
1831	if (!device)
1832		return -EINVAL;
1833
1834	if (!device->ops.alloc_hw_stats || !device->ops.get_hw_stats) {
1835		ret = -EINVAL;
1836		goto err;
1837	}
1838
1839	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1840	if (!rdma_is_port_valid(device, port)) {
 
1841		ret = -EINVAL;
1842		goto err;
1843	}
1844
1845	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1846	if (!msg) {
1847		ret = -ENOMEM;
1848		goto err;
1849	}
1850
1851	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1852			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1853					 RDMA_NLDEV_CMD_STAT_GET),
1854			0, 0);
1855
1856	if (fill_nldev_handle(msg, device) ||
1857	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port)) {
1858		ret = -EMSGSIZE;
1859		goto err_msg;
1860	}
1861
1862	stats = device->port_data ? device->port_data[port].hw_stats : NULL;
1863	if (stats == NULL) {
1864		ret = -EINVAL;
1865		goto err_msg;
1866	}
1867	mutex_lock(&stats->lock);
1868
1869	num_cnts = device->ops.get_hw_stats(device, stats, port, 0);
1870	if (num_cnts < 0) {
1871		ret = -EINVAL;
1872		goto err_stats;
1873	}
1874
1875	table_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTERS);
1876	if (!table_attr) {
1877		ret = -EMSGSIZE;
1878		goto err_stats;
1879	}
1880	for (i = 0; i < num_cnts; i++) {
 
 
 
1881		v = stats->value[i] +
1882			rdma_counter_get_hwstat_value(device, port, i);
1883		if (fill_stat_hwcounter_entry(msg, stats->names[i], v)) {
 
1884			ret = -EMSGSIZE;
1885			goto err_table;
1886		}
1887	}
1888	nla_nest_end(msg, table_attr);
1889
1890	mutex_unlock(&stats->lock);
1891	nlmsg_end(msg, nlh);
1892	ib_device_put(device);
1893	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1894
1895err_table:
1896	nla_nest_cancel(msg, table_attr);
1897err_stats:
1898	mutex_unlock(&stats->lock);
1899err_msg:
1900	nlmsg_free(msg);
1901err:
1902	ib_device_put(device);
1903	return ret;
1904}
1905
1906static int stat_get_doit_qp(struct sk_buff *skb, struct nlmsghdr *nlh,
1907			    struct netlink_ext_ack *extack, struct nlattr *tb[])
1908
1909{
1910	static enum rdma_nl_counter_mode mode;
1911	static enum rdma_nl_counter_mask mask;
1912	struct ib_device *device;
1913	struct sk_buff *msg;
1914	u32 index, port;
1915	int ret;
1916
1917	if (tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID])
1918		return nldev_res_get_counter_doit(skb, nlh, extack);
1919
1920	if (!tb[RDMA_NLDEV_ATTR_STAT_MODE] ||
1921	    !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
1922		return -EINVAL;
1923
1924	index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1925	device = ib_device_get_by_index(sock_net(skb->sk), index);
1926	if (!device)
1927		return -EINVAL;
1928
1929	port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1930	if (!rdma_is_port_valid(device, port)) {
1931		ret = -EINVAL;
1932		goto err;
1933	}
1934
1935	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1936	if (!msg) {
1937		ret = -ENOMEM;
1938		goto err;
1939	}
1940
1941	nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1942			RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1943					 RDMA_NLDEV_CMD_STAT_GET),
1944			0, 0);
 
 
 
 
1945
1946	ret = rdma_counter_get_mode(device, port, &mode, &mask);
1947	if (ret)
1948		goto err_msg;
1949
1950	if (fill_nldev_handle(msg, device) ||
1951	    nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port) ||
1952	    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_MODE, mode)) {
1953		ret = -EMSGSIZE;
1954		goto err_msg;
1955	}
1956
1957	if ((mode == RDMA_COUNTER_MODE_AUTO) &&
1958	    nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK, mask)) {
1959		ret = -EMSGSIZE;
1960		goto err_msg;
1961	}
1962
1963	nlmsg_end(msg, nlh);
1964	ib_device_put(device);
1965	return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1966
1967err_msg:
1968	nlmsg_free(msg);
1969err:
1970	ib_device_put(device);
1971	return ret;
1972}
1973
1974static int nldev_stat_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1975			       struct netlink_ext_ack *extack)
1976{
1977	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1978	int ret;
1979
1980	ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1981			  nldev_policy, extack);
1982	if (ret)
1983		return -EINVAL;
1984
1985	if (!tb[RDMA_NLDEV_ATTR_STAT_RES])
1986		return stat_get_doit_default_counter(skb, nlh, extack, tb);
1987
1988	switch (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES])) {
1989	case RDMA_NLDEV_ATTR_RES_QP:
1990		ret = stat_get_doit_qp(skb, nlh, extack, tb);
1991		break;
1992
 
 
 
1993	default:
1994		ret = -EINVAL;
1995		break;
1996	}
1997
1998	return ret;
1999}
2000
2001static int nldev_stat_get_dumpit(struct sk_buff *skb,
2002				 struct netlink_callback *cb)
2003{
2004	struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2005	int ret;
2006
2007	ret = nlmsg_parse(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2008			  nldev_policy, NULL);
2009	if (ret || !tb[RDMA_NLDEV_ATTR_STAT_RES])
2010		return -EINVAL;
2011
2012	switch (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES])) {
2013	case RDMA_NLDEV_ATTR_RES_QP:
2014		ret = nldev_res_get_counter_dumpit(skb, cb);
2015		break;
2016
 
 
 
2017	default:
2018		ret = -EINVAL;
2019		break;
2020	}
2021
2022	return ret;
2023}
2024
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2025static const struct rdma_nl_cbs nldev_cb_table[RDMA_NLDEV_NUM_OPS] = {
2026	[RDMA_NLDEV_CMD_GET] = {
2027		.doit = nldev_get_doit,
2028		.dump = nldev_get_dumpit,
2029	},
2030	[RDMA_NLDEV_CMD_GET_CHARDEV] = {
2031		.doit = nldev_get_chardev,
2032	},
2033	[RDMA_NLDEV_CMD_SET] = {
2034		.doit = nldev_set_doit,
2035		.flags = RDMA_NL_ADMIN_PERM,
2036	},
2037	[RDMA_NLDEV_CMD_NEWLINK] = {
2038		.doit = nldev_newlink,
2039		.flags = RDMA_NL_ADMIN_PERM,
2040	},
2041	[RDMA_NLDEV_CMD_DELLINK] = {
2042		.doit = nldev_dellink,
2043		.flags = RDMA_NL_ADMIN_PERM,
2044	},
2045	[RDMA_NLDEV_CMD_PORT_GET] = {
2046		.doit = nldev_port_get_doit,
2047		.dump = nldev_port_get_dumpit,
2048	},
2049	[RDMA_NLDEV_CMD_RES_GET] = {
2050		.doit = nldev_res_get_doit,
2051		.dump = nldev_res_get_dumpit,
2052	},
2053	[RDMA_NLDEV_CMD_RES_QP_GET] = {
2054		.doit = nldev_res_get_qp_doit,
2055		.dump = nldev_res_get_qp_dumpit,
2056	},
2057	[RDMA_NLDEV_CMD_RES_CM_ID_GET] = {
2058		.doit = nldev_res_get_cm_id_doit,
2059		.dump = nldev_res_get_cm_id_dumpit,
2060	},
2061	[RDMA_NLDEV_CMD_RES_CQ_GET] = {
2062		.doit = nldev_res_get_cq_doit,
2063		.dump = nldev_res_get_cq_dumpit,
2064	},
2065	[RDMA_NLDEV_CMD_RES_MR_GET] = {
2066		.doit = nldev_res_get_mr_doit,
2067		.dump = nldev_res_get_mr_dumpit,
2068	},
2069	[RDMA_NLDEV_CMD_RES_PD_GET] = {
2070		.doit = nldev_res_get_pd_doit,
2071		.dump = nldev_res_get_pd_dumpit,
2072	},
 
 
 
 
 
 
 
 
2073	[RDMA_NLDEV_CMD_SYS_GET] = {
2074		.doit = nldev_sys_get_doit,
2075	},
2076	[RDMA_NLDEV_CMD_SYS_SET] = {
2077		.doit = nldev_set_sys_set_doit,
 
2078	},
2079	[RDMA_NLDEV_CMD_STAT_SET] = {
2080		.doit = nldev_stat_set_doit,
2081		.flags = RDMA_NL_ADMIN_PERM,
2082	},
2083	[RDMA_NLDEV_CMD_STAT_GET] = {
2084		.doit = nldev_stat_get_doit,
2085		.dump = nldev_stat_get_dumpit,
2086	},
2087	[RDMA_NLDEV_CMD_STAT_DEL] = {
2088		.doit = nldev_stat_del_doit,
2089		.flags = RDMA_NL_ADMIN_PERM,
2090	},
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2091};
2092
2093void __init nldev_init(void)
2094{
2095	rdma_nl_register(RDMA_NL_NLDEV, nldev_cb_table);
2096}
2097
2098void __exit nldev_exit(void)
2099{
2100	rdma_nl_unregister(RDMA_NL_NLDEV);
2101}
2102
2103MODULE_ALIAS_RDMA_NETLINK(RDMA_NL_NLDEV, 5);