Linux Audio

Check our new training course

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