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 */
51 static bool privileged_qkey;
52
53 typedef 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 */
59 static 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
put_driver_name_print_type(struct sk_buff * msg,const char * name,enum rdma_nldev_print_type print_type)176 static 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
_rdma_nl_put_driver_u32(struct sk_buff * msg,const char * name,enum rdma_nldev_print_type print_type,u32 value)188 static 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
_rdma_nl_put_driver_u64(struct sk_buff * msg,const char * name,enum rdma_nldev_print_type print_type,u64 value)200 static 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
rdma_nl_put_driver_string(struct sk_buff * msg,const char * name,const char * str)213 int 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 }
224 EXPORT_SYMBOL(rdma_nl_put_driver_string);
225
rdma_nl_put_driver_u32(struct sk_buff * msg,const char * name,u32 value)226 int 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 }
231 EXPORT_SYMBOL(rdma_nl_put_driver_u32);
232
rdma_nl_put_driver_u32_hex(struct sk_buff * msg,const char * name,u32 value)233 int 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 }
239 EXPORT_SYMBOL(rdma_nl_put_driver_u32_hex);
240
rdma_nl_put_driver_u64(struct sk_buff * msg,const char * name,u64 value)241 int 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 }
246 EXPORT_SYMBOL(rdma_nl_put_driver_u64);
247
rdma_nl_put_driver_u64_hex(struct sk_buff * msg,const char * name,u64 value)248 int 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 }
253 EXPORT_SYMBOL(rdma_nl_put_driver_u64_hex);
254
rdma_nl_get_privileged_qkey(void)255 bool rdma_nl_get_privileged_qkey(void)
256 {
257 return privileged_qkey || capable(CAP_NET_RAW);
258 }
259 EXPORT_SYMBOL(rdma_nl_get_privileged_qkey);
260
fill_nldev_handle(struct sk_buff * msg,struct ib_device * device)261 static 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
fill_dev_info(struct sk_buff * msg,struct ib_device * device)272 static 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
fill_port_info(struct sk_buff * msg,struct ib_device * device,u32 port,const struct net * net)341 static 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
393 out:
394 dev_put(netdev);
395 return ret;
396 }
397
fill_res_info_entry(struct sk_buff * msg,const char * name,u64 curr)398 static 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
417 err:
418 nla_nest_cancel(msg, entry_attr);
419 return -EMSGSIZE;
420 }
421
fill_res_info(struct sk_buff * msg,struct ib_device * device,bool show_details)422 static 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
457 err:
458 nla_nest_cancel(msg, table_attr);
459 return ret;
460 }
461
fill_res_name_pid(struct sk_buff * msg,struct rdma_restrack_entry * res)462 static 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
fill_res_qp_entry_query(struct sk_buff * msg,struct rdma_restrack_entry * res,struct ib_device * dev,struct ib_qp * qp)495 static 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
535 err: return -EMSGSIZE;
536 }
537
fill_res_qp_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)538 static 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
fill_res_qp_raw_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)567 static 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
fill_res_cm_id_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)580 static 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
629 err: return -EMSGSIZE;
630 }
631
fill_res_cq_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)632 static 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
fill_res_cq_raw_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)666 static 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
fill_res_mr_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)677 static 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
fill_res_mr_raw_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)709 static 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
fill_res_pd_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)720 static 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
748 err: return -EMSGSIZE;
749 }
750
fill_res_ctx_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)751 static 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
fill_res_range_qp_entry(struct sk_buff * msg,uint32_t min_range,uint32_t max_range)765 static 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
789 err:
790 nla_nest_cancel(msg, entry_attr);
791 return -EMSGSIZE;
792 }
793
fill_res_srq_qps(struct sk_buff * msg,struct ib_srq * srq)794 static 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
843 err_loop:
844 rdma_restrack_put(res);
845 xa_unlock(&rt->xa);
846 err:
847 nla_nest_cancel(msg, table_attr);
848 return -EMSGSIZE;
849 }
850
fill_res_srq_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)851 static 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
883 err:
884 return -EMSGSIZE;
885 }
886
fill_res_srq_raw_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)887 static 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
fill_stat_counter_mode(struct sk_buff * msg,struct rdma_counter * counter)898 static 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
fill_stat_counter_qp_entry(struct sk_buff * msg,u32 qpn)919 static 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
933 err:
934 nla_nest_cancel(msg, entry_attr);
935 return -EMSGSIZE;
936 }
937
fill_stat_counter_qps(struct sk_buff * msg,struct rdma_counter * counter)938 static 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
968 err:
969 xa_unlock(&rt->xa);
970 nla_nest_cancel(msg, table_attr);
971 return ret;
972 }
973
rdma_nl_stat_hwcounter_entry(struct sk_buff * msg,const char * name,u64 value)974 int 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
993 err:
994 nla_nest_cancel(msg, entry_attr);
995 return -EMSGSIZE;
996 }
997 EXPORT_SYMBOL(rdma_nl_stat_hwcounter_entry);
998
fill_stat_mr_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)999 static 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
1012 err:
1013 return -EMSGSIZE;
1014 }
1015
fill_stat_counter_hwcounters(struct sk_buff * msg,struct rdma_counter * counter)1016 static 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
1040 err:
1041 mutex_unlock(&st->lock);
1042 nla_nest_cancel(msg, table_attr);
1043 return -EMSGSIZE;
1044 }
1045
fill_res_counter_entry(struct sk_buff * msg,bool has_cap_net_admin,struct rdma_restrack_entry * res,uint32_t port)1046 static 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
nldev_get_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)1069 static 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
1112 err_free:
1113 nlmsg_free(msg);
1114 err:
1115 ib_device_put(device);
1116 return err;
1117 }
1118
nldev_set_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)1119 static 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
1166 done:
1167 ib_device_put(device);
1168 put_done:
1169 return err;
1170 }
1171
_nldev_get_dumpit(struct ib_device * device,struct sk_buff * skb,struct netlink_callback * cb,unsigned int idx)1172 static 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
1196 out: cb->args[0] = idx;
1197 return skb->len;
1198 }
1199
nldev_get_dumpit(struct sk_buff * skb,struct netlink_callback * cb)1200 static 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
nldev_port_get_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)1209 static 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
1260 err_free:
1261 nlmsg_free(msg);
1262 err:
1263 ib_device_put(device);
1264 return err;
1265 }
1266
nldev_port_get_dumpit(struct sk_buff * skb,struct netlink_callback * cb)1267 static 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
1319 out:
1320 ib_device_put(device);
1321 cb->args[0] = idx;
1322 return skb->len;
1323 }
1324
nldev_res_get_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)1325 static 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
1370 err_free:
1371 nlmsg_free(msg);
1372 err:
1373 ib_device_put(device);
1374 return ret;
1375 }
1376
_nldev_res_get_dumpit(struct ib_device * device,struct sk_buff * skb,struct netlink_callback * cb,unsigned int idx)1377 static 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
1400 out:
1401 cb->args[0] = idx;
1402 return skb->len;
1403 }
1404
nldev_res_get_dumpit(struct sk_buff * skb,struct netlink_callback * cb)1405 static 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
1411 struct nldev_fill_res_entry {
1412 enum rdma_nldev_attr nldev_attr;
1413 u8 flags;
1414 u32 entry;
1415 u32 id;
1416 };
1417
1418 enum nldev_res_flags {
1419 NLDEV_PER_DEV = 1 << 0,
1420 };
1421
1422 static 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
1471 static noinline_for_stack int
res_get_common_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack,enum rdma_restrack_type res_type,res_fill_func_t fill_func)1472 res_get_common_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1473 struct netlink_ext_ack *extack,
1474 enum rdma_restrack_type res_type,
1475 res_fill_func_t fill_func)
1476 {
1477 const struct nldev_fill_res_entry *fe = &fill_entries[res_type];
1478 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1479 struct rdma_restrack_entry *res;
1480 struct ib_device *device;
1481 u32 index, id, port = 0;
1482 bool has_cap_net_admin;
1483 struct sk_buff *msg;
1484 int ret;
1485
1486 ret = __nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1487 nldev_policy, NL_VALIDATE_LIBERAL, extack);
1488 if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !fe->id || !tb[fe->id])
1489 return -EINVAL;
1490
1491 index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1492 device = ib_device_get_by_index(sock_net(skb->sk), index);
1493 if (!device)
1494 return -EINVAL;
1495
1496 if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1497 port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1498 if (!rdma_is_port_valid(device, port)) {
1499 ret = -EINVAL;
1500 goto err;
1501 }
1502 }
1503
1504 if ((port && fe->flags & NLDEV_PER_DEV) ||
1505 (!port && ~fe->flags & NLDEV_PER_DEV)) {
1506 ret = -EINVAL;
1507 goto err;
1508 }
1509
1510 id = nla_get_u32(tb[fe->id]);
1511 res = rdma_restrack_get_byid(device, res_type, id);
1512 if (IS_ERR(res)) {
1513 ret = PTR_ERR(res);
1514 goto err;
1515 }
1516
1517 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1518 if (!msg) {
1519 ret = -ENOMEM;
1520 goto err_get;
1521 }
1522
1523 nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1524 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1525 RDMA_NL_GET_OP(nlh->nlmsg_type)),
1526 0, 0);
1527
1528 if (!nlh || fill_nldev_handle(msg, device)) {
1529 ret = -EMSGSIZE;
1530 goto err_free;
1531 }
1532
1533 has_cap_net_admin = netlink_capable(skb, CAP_NET_ADMIN);
1534
1535 ret = fill_func(msg, has_cap_net_admin, res, port);
1536 if (ret)
1537 goto err_free;
1538
1539 rdma_restrack_put(res);
1540 nlmsg_end(msg, nlh);
1541 ib_device_put(device);
1542 return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1543
1544 err_free:
1545 nlmsg_free(msg);
1546 err_get:
1547 rdma_restrack_put(res);
1548 err:
1549 ib_device_put(device);
1550 return ret;
1551 }
1552
res_get_common_dumpit(struct sk_buff * skb,struct netlink_callback * cb,enum rdma_restrack_type res_type,res_fill_func_t fill_func)1553 static int res_get_common_dumpit(struct sk_buff *skb,
1554 struct netlink_callback *cb,
1555 enum rdma_restrack_type res_type,
1556 res_fill_func_t fill_func)
1557 {
1558 const struct nldev_fill_res_entry *fe = &fill_entries[res_type];
1559 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1560 struct rdma_restrack_entry *res;
1561 struct rdma_restrack_root *rt;
1562 int err, ret = 0, idx = 0;
1563 bool show_details = false;
1564 struct nlattr *table_attr;
1565 struct nlattr *entry_attr;
1566 struct ib_device *device;
1567 int start = cb->args[0];
1568 bool has_cap_net_admin;
1569 struct nlmsghdr *nlh;
1570 unsigned long id;
1571 u32 index, port = 0;
1572 bool filled = false;
1573
1574 err = __nlmsg_parse(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1575 nldev_policy, NL_VALIDATE_LIBERAL, NULL);
1576 /*
1577 * Right now, we are expecting the device index to get res information,
1578 * but it is possible to extend this code to return all devices in
1579 * one shot by checking the existence of RDMA_NLDEV_ATTR_DEV_INDEX.
1580 * if it doesn't exist, we will iterate over all devices.
1581 *
1582 * But it is not needed for now.
1583 */
1584 if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1585 return -EINVAL;
1586
1587 index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1588 device = ib_device_get_by_index(sock_net(skb->sk), index);
1589 if (!device)
1590 return -EINVAL;
1591
1592 if (tb[RDMA_NLDEV_ATTR_DRIVER_DETAILS])
1593 show_details = nla_get_u8(tb[RDMA_NLDEV_ATTR_DRIVER_DETAILS]);
1594
1595 /*
1596 * If no PORT_INDEX is supplied, we will return all QPs from that device
1597 */
1598 if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1599 port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1600 if (!rdma_is_port_valid(device, port)) {
1601 ret = -EINVAL;
1602 goto err_index;
1603 }
1604 }
1605
1606 nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
1607 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1608 RDMA_NL_GET_OP(cb->nlh->nlmsg_type)),
1609 0, NLM_F_MULTI);
1610
1611 if (!nlh || fill_nldev_handle(skb, device)) {
1612 ret = -EMSGSIZE;
1613 goto err;
1614 }
1615
1616 table_attr = nla_nest_start_noflag(skb, fe->nldev_attr);
1617 if (!table_attr) {
1618 ret = -EMSGSIZE;
1619 goto err;
1620 }
1621
1622 has_cap_net_admin = netlink_capable(cb->skb, CAP_NET_ADMIN);
1623
1624 rt = &device->res[res_type];
1625 xa_lock(&rt->xa);
1626 /*
1627 * FIXME: if the skip ahead is something common this loop should
1628 * use xas_for_each & xas_pause to optimize, we can have a lot of
1629 * objects.
1630 */
1631 xa_for_each(&rt->xa, id, res) {
1632 if (xa_get_mark(&rt->xa, res->id, RESTRACK_DD) && !show_details)
1633 goto next;
1634
1635 if (idx < start || !rdma_restrack_get(res))
1636 goto next;
1637
1638 xa_unlock(&rt->xa);
1639
1640 filled = true;
1641
1642 entry_attr = nla_nest_start_noflag(skb, fe->entry);
1643 if (!entry_attr) {
1644 ret = -EMSGSIZE;
1645 rdma_restrack_put(res);
1646 goto msg_full;
1647 }
1648
1649 ret = fill_func(skb, has_cap_net_admin, res, port);
1650
1651 rdma_restrack_put(res);
1652
1653 if (ret) {
1654 nla_nest_cancel(skb, entry_attr);
1655 if (ret == -EMSGSIZE)
1656 goto msg_full;
1657 if (ret == -EAGAIN)
1658 goto again;
1659 goto res_err;
1660 }
1661 nla_nest_end(skb, entry_attr);
1662 again: xa_lock(&rt->xa);
1663 next: idx++;
1664 }
1665 xa_unlock(&rt->xa);
1666
1667 msg_full:
1668 nla_nest_end(skb, table_attr);
1669 nlmsg_end(skb, nlh);
1670 cb->args[0] = idx;
1671
1672 /*
1673 * No more entries to fill, cancel the message and
1674 * return 0 to mark end of dumpit.
1675 */
1676 if (!filled)
1677 goto err;
1678
1679 ib_device_put(device);
1680 return skb->len;
1681
1682 res_err:
1683 nla_nest_cancel(skb, table_attr);
1684
1685 err:
1686 nlmsg_cancel(skb, nlh);
1687
1688 err_index:
1689 ib_device_put(device);
1690 return ret;
1691 }
1692
1693 #define RES_GET_FUNCS(name, type) \
1694 static int nldev_res_get_##name##_dumpit(struct sk_buff *skb, \
1695 struct netlink_callback *cb) \
1696 { \
1697 return res_get_common_dumpit(skb, cb, type, \
1698 fill_res_##name##_entry); \
1699 } \
1700 static int nldev_res_get_##name##_doit(struct sk_buff *skb, \
1701 struct nlmsghdr *nlh, \
1702 struct netlink_ext_ack *extack) \
1703 { \
1704 return res_get_common_doit(skb, nlh, extack, type, \
1705 fill_res_##name##_entry); \
1706 }
1707
1708 RES_GET_FUNCS(qp, RDMA_RESTRACK_QP);
1709 RES_GET_FUNCS(qp_raw, RDMA_RESTRACK_QP);
1710 RES_GET_FUNCS(cm_id, RDMA_RESTRACK_CM_ID);
1711 RES_GET_FUNCS(cq, RDMA_RESTRACK_CQ);
1712 RES_GET_FUNCS(cq_raw, RDMA_RESTRACK_CQ);
1713 RES_GET_FUNCS(pd, RDMA_RESTRACK_PD);
1714 RES_GET_FUNCS(mr, RDMA_RESTRACK_MR);
1715 RES_GET_FUNCS(mr_raw, RDMA_RESTRACK_MR);
1716 RES_GET_FUNCS(counter, RDMA_RESTRACK_COUNTER);
1717 RES_GET_FUNCS(ctx, RDMA_RESTRACK_CTX);
1718 RES_GET_FUNCS(srq, RDMA_RESTRACK_SRQ);
1719 RES_GET_FUNCS(srq_raw, RDMA_RESTRACK_SRQ);
1720
1721 static LIST_HEAD(link_ops);
1722 static DECLARE_RWSEM(link_ops_rwsem);
1723
link_ops_get(const char * type)1724 static const struct rdma_link_ops *link_ops_get(const char *type)
1725 {
1726 const struct rdma_link_ops *ops;
1727
1728 list_for_each_entry(ops, &link_ops, list) {
1729 if (!strcmp(ops->type, type))
1730 goto out;
1731 }
1732 ops = NULL;
1733 out:
1734 return ops;
1735 }
1736
rdma_link_register(struct rdma_link_ops * ops)1737 void rdma_link_register(struct rdma_link_ops *ops)
1738 {
1739 down_write(&link_ops_rwsem);
1740 if (WARN_ON_ONCE(link_ops_get(ops->type)))
1741 goto out;
1742 list_add(&ops->list, &link_ops);
1743 out:
1744 up_write(&link_ops_rwsem);
1745 }
1746 EXPORT_SYMBOL(rdma_link_register);
1747
rdma_link_unregister(struct rdma_link_ops * ops)1748 void rdma_link_unregister(struct rdma_link_ops *ops)
1749 {
1750 down_write(&link_ops_rwsem);
1751 list_del(&ops->list);
1752 up_write(&link_ops_rwsem);
1753 }
1754 EXPORT_SYMBOL(rdma_link_unregister);
1755
nldev_newlink(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)1756 static int nldev_newlink(struct sk_buff *skb, struct nlmsghdr *nlh,
1757 struct netlink_ext_ack *extack)
1758 {
1759 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1760 char ibdev_name[IB_DEVICE_NAME_MAX];
1761 const struct rdma_link_ops *ops;
1762 char ndev_name[IFNAMSIZ];
1763 struct net_device *ndev;
1764 char type[IFNAMSIZ];
1765 int err;
1766
1767 err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1768 nldev_policy, extack);
1769 if (err || !tb[RDMA_NLDEV_ATTR_DEV_NAME] ||
1770 !tb[RDMA_NLDEV_ATTR_LINK_TYPE] || !tb[RDMA_NLDEV_ATTR_NDEV_NAME])
1771 return -EINVAL;
1772
1773 nla_strscpy(ibdev_name, tb[RDMA_NLDEV_ATTR_DEV_NAME],
1774 sizeof(ibdev_name));
1775 if (strchr(ibdev_name, '%') || strlen(ibdev_name) == 0)
1776 return -EINVAL;
1777
1778 nla_strscpy(type, tb[RDMA_NLDEV_ATTR_LINK_TYPE], sizeof(type));
1779 nla_strscpy(ndev_name, tb[RDMA_NLDEV_ATTR_NDEV_NAME],
1780 sizeof(ndev_name));
1781
1782 ndev = dev_get_by_name(sock_net(skb->sk), ndev_name);
1783 if (!ndev)
1784 return -ENODEV;
1785
1786 down_read(&link_ops_rwsem);
1787 ops = link_ops_get(type);
1788 #ifdef CONFIG_MODULES
1789 if (!ops) {
1790 up_read(&link_ops_rwsem);
1791 request_module("rdma-link-%s", type);
1792 down_read(&link_ops_rwsem);
1793 ops = link_ops_get(type);
1794 }
1795 #endif
1796 err = ops ? ops->newlink(ibdev_name, ndev) : -EINVAL;
1797 up_read(&link_ops_rwsem);
1798 dev_put(ndev);
1799
1800 return err;
1801 }
1802
nldev_dellink(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)1803 static int nldev_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
1804 struct netlink_ext_ack *extack)
1805 {
1806 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1807 struct ib_device *device;
1808 u32 index;
1809 int err;
1810
1811 err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1812 nldev_policy, extack);
1813 if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
1814 return -EINVAL;
1815
1816 index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1817 device = ib_device_get_by_index(sock_net(skb->sk), index);
1818 if (!device)
1819 return -EINVAL;
1820
1821 if (!(device->attrs.kernel_cap_flags & IBK_ALLOW_USER_UNREG)) {
1822 ib_device_put(device);
1823 return -EINVAL;
1824 }
1825
1826 ib_unregister_device_and_put(device);
1827 return 0;
1828 }
1829
nldev_get_chardev(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)1830 static int nldev_get_chardev(struct sk_buff *skb, struct nlmsghdr *nlh,
1831 struct netlink_ext_ack *extack)
1832 {
1833 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1834 char client_name[RDMA_NLDEV_ATTR_CHARDEV_TYPE_SIZE];
1835 struct ib_client_nl_info data = {};
1836 struct ib_device *ibdev = NULL;
1837 struct sk_buff *msg;
1838 u32 index;
1839 int err;
1840
1841 err = __nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1, nldev_policy,
1842 NL_VALIDATE_LIBERAL, extack);
1843 if (err || !tb[RDMA_NLDEV_ATTR_CHARDEV_TYPE])
1844 return -EINVAL;
1845
1846 nla_strscpy(client_name, tb[RDMA_NLDEV_ATTR_CHARDEV_TYPE],
1847 sizeof(client_name));
1848
1849 if (tb[RDMA_NLDEV_ATTR_DEV_INDEX]) {
1850 index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
1851 ibdev = ib_device_get_by_index(sock_net(skb->sk), index);
1852 if (!ibdev)
1853 return -EINVAL;
1854
1855 if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1856 data.port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
1857 if (!rdma_is_port_valid(ibdev, data.port)) {
1858 err = -EINVAL;
1859 goto out_put;
1860 }
1861 } else {
1862 data.port = -1;
1863 }
1864 } else if (tb[RDMA_NLDEV_ATTR_PORT_INDEX]) {
1865 return -EINVAL;
1866 }
1867
1868 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1869 if (!msg) {
1870 err = -ENOMEM;
1871 goto out_put;
1872 }
1873 nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1874 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1875 RDMA_NLDEV_CMD_GET_CHARDEV),
1876 0, 0);
1877 if (!nlh) {
1878 err = -EMSGSIZE;
1879 goto out_nlmsg;
1880 }
1881
1882 data.nl_msg = msg;
1883 err = ib_get_client_nl_info(ibdev, client_name, &data);
1884 if (err)
1885 goto out_nlmsg;
1886
1887 err = nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CHARDEV,
1888 huge_encode_dev(data.cdev->devt),
1889 RDMA_NLDEV_ATTR_PAD);
1890 if (err)
1891 goto out_data;
1892 err = nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CHARDEV_ABI, data.abi,
1893 RDMA_NLDEV_ATTR_PAD);
1894 if (err)
1895 goto out_data;
1896 if (nla_put_string(msg, RDMA_NLDEV_ATTR_CHARDEV_NAME,
1897 dev_name(data.cdev))) {
1898 err = -EMSGSIZE;
1899 goto out_data;
1900 }
1901
1902 nlmsg_end(msg, nlh);
1903 put_device(data.cdev);
1904 if (ibdev)
1905 ib_device_put(ibdev);
1906 return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1907
1908 out_data:
1909 put_device(data.cdev);
1910 out_nlmsg:
1911 nlmsg_free(msg);
1912 out_put:
1913 if (ibdev)
1914 ib_device_put(ibdev);
1915 return err;
1916 }
1917
nldev_sys_get_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)1918 static int nldev_sys_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
1919 struct netlink_ext_ack *extack)
1920 {
1921 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
1922 struct sk_buff *msg;
1923 int err;
1924
1925 err = __nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
1926 nldev_policy, NL_VALIDATE_LIBERAL, extack);
1927 if (err)
1928 return err;
1929
1930 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1931 if (!msg)
1932 return -ENOMEM;
1933
1934 nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
1935 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
1936 RDMA_NLDEV_CMD_SYS_GET),
1937 0, 0);
1938 if (!nlh) {
1939 nlmsg_free(msg);
1940 return -EMSGSIZE;
1941 }
1942
1943 err = nla_put_u8(msg, RDMA_NLDEV_SYS_ATTR_NETNS_MODE,
1944 (u8)ib_devices_shared_netns);
1945 if (err) {
1946 nlmsg_free(msg);
1947 return err;
1948 }
1949
1950 err = nla_put_u8(msg, RDMA_NLDEV_SYS_ATTR_PRIVILEGED_QKEY_MODE,
1951 (u8)privileged_qkey);
1952 if (err) {
1953 nlmsg_free(msg);
1954 return err;
1955 }
1956
1957 err = nla_put_u8(msg, RDMA_NLDEV_SYS_ATTR_MONITOR_MODE, 1);
1958 if (err) {
1959 nlmsg_free(msg);
1960 return err;
1961 }
1962 /*
1963 * Copy-on-fork is supported.
1964 * See commits:
1965 * 70e806e4e645 ("mm: Do early cow for pinned pages during fork() for ptes")
1966 * 4eae4efa2c29 ("hugetlb: do early cow when page pinned on src mm")
1967 * for more details. Don't backport this without them.
1968 *
1969 * Return value ignored on purpose, assume copy-on-fork is not
1970 * supported in case of failure.
1971 */
1972 nla_put_u8(msg, RDMA_NLDEV_SYS_ATTR_COPY_ON_FORK, 1);
1973
1974 nlmsg_end(msg, nlh);
1975 return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
1976 }
1977
nldev_set_sys_set_netns_doit(struct nlattr * tb[])1978 static int nldev_set_sys_set_netns_doit(struct nlattr *tb[])
1979 {
1980 u8 enable;
1981 int err;
1982
1983 enable = nla_get_u8(tb[RDMA_NLDEV_SYS_ATTR_NETNS_MODE]);
1984 /* Only 0 and 1 are supported */
1985 if (enable > 1)
1986 return -EINVAL;
1987
1988 err = rdma_compatdev_set(enable);
1989 return err;
1990 }
1991
nldev_set_sys_set_pqkey_doit(struct nlattr * tb[])1992 static int nldev_set_sys_set_pqkey_doit(struct nlattr *tb[])
1993 {
1994 u8 enable;
1995
1996 enable = nla_get_u8(tb[RDMA_NLDEV_SYS_ATTR_PRIVILEGED_QKEY_MODE]);
1997 /* Only 0 and 1 are supported */
1998 if (enable > 1)
1999 return -EINVAL;
2000
2001 privileged_qkey = enable;
2002 return 0;
2003 }
2004
nldev_set_sys_set_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)2005 static int nldev_set_sys_set_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
2006 struct netlink_ext_ack *extack)
2007 {
2008 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2009 int err;
2010
2011 err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2012 nldev_policy, extack);
2013 if (err)
2014 return -EINVAL;
2015
2016 if (tb[RDMA_NLDEV_SYS_ATTR_NETNS_MODE])
2017 return nldev_set_sys_set_netns_doit(tb);
2018
2019 if (tb[RDMA_NLDEV_SYS_ATTR_PRIVILEGED_QKEY_MODE])
2020 return nldev_set_sys_set_pqkey_doit(tb);
2021
2022 return -EINVAL;
2023 }
2024
2025
nldev_stat_set_mode_doit(struct sk_buff * msg,struct netlink_ext_ack * extack,struct nlattr * tb[],struct ib_device * device,u32 port)2026 static int nldev_stat_set_mode_doit(struct sk_buff *msg,
2027 struct netlink_ext_ack *extack,
2028 struct nlattr *tb[],
2029 struct ib_device *device, u32 port)
2030 {
2031 u32 mode, mask = 0, qpn, cntn = 0;
2032 int ret;
2033
2034 /* Currently only counter for QP is supported */
2035 if (!tb[RDMA_NLDEV_ATTR_STAT_RES] ||
2036 nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES]) != RDMA_NLDEV_ATTR_RES_QP)
2037 return -EINVAL;
2038
2039 mode = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_MODE]);
2040 if (mode == RDMA_COUNTER_MODE_AUTO) {
2041 if (tb[RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK])
2042 mask = nla_get_u32(
2043 tb[RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK]);
2044 return rdma_counter_set_auto_mode(device, port, mask, extack);
2045 }
2046
2047 if (!tb[RDMA_NLDEV_ATTR_RES_LQPN])
2048 return -EINVAL;
2049
2050 qpn = nla_get_u32(tb[RDMA_NLDEV_ATTR_RES_LQPN]);
2051 if (tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]) {
2052 cntn = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]);
2053 ret = rdma_counter_bind_qpn(device, port, qpn, cntn);
2054 if (ret)
2055 return ret;
2056 } else {
2057 ret = rdma_counter_bind_qpn_alloc(device, port, qpn, &cntn);
2058 if (ret)
2059 return ret;
2060 }
2061
2062 if (nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_COUNTER_ID, cntn) ||
2063 nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qpn)) {
2064 ret = -EMSGSIZE;
2065 goto err_fill;
2066 }
2067
2068 return 0;
2069
2070 err_fill:
2071 rdma_counter_unbind_qpn(device, port, qpn, cntn);
2072 return ret;
2073 }
2074
nldev_stat_set_counter_dynamic_doit(struct nlattr * tb[],struct ib_device * device,u32 port)2075 static int nldev_stat_set_counter_dynamic_doit(struct nlattr *tb[],
2076 struct ib_device *device,
2077 u32 port)
2078 {
2079 struct rdma_hw_stats *stats;
2080 struct nlattr *entry_attr;
2081 unsigned long *target;
2082 int rem, i, ret = 0;
2083 u32 index;
2084
2085 stats = ib_get_hw_stats_port(device, port);
2086 if (!stats)
2087 return -EINVAL;
2088
2089 target = kcalloc(BITS_TO_LONGS(stats->num_counters),
2090 sizeof(*stats->is_disabled), GFP_KERNEL);
2091 if (!target)
2092 return -ENOMEM;
2093
2094 nla_for_each_nested(entry_attr, tb[RDMA_NLDEV_ATTR_STAT_HWCOUNTERS],
2095 rem) {
2096 index = nla_get_u32(entry_attr);
2097 if ((index >= stats->num_counters) ||
2098 !(stats->descs[index].flags & IB_STAT_FLAG_OPTIONAL)) {
2099 ret = -EINVAL;
2100 goto out;
2101 }
2102
2103 set_bit(index, target);
2104 }
2105
2106 for (i = 0; i < stats->num_counters; i++) {
2107 if (!(stats->descs[i].flags & IB_STAT_FLAG_OPTIONAL))
2108 continue;
2109
2110 ret = rdma_counter_modify(device, port, i, test_bit(i, target));
2111 if (ret)
2112 goto out;
2113 }
2114
2115 out:
2116 kfree(target);
2117 return ret;
2118 }
2119
nldev_stat_set_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)2120 static int nldev_stat_set_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
2121 struct netlink_ext_ack *extack)
2122 {
2123 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2124 struct ib_device *device;
2125 struct sk_buff *msg;
2126 u32 index, port;
2127 int ret;
2128
2129 ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1, nldev_policy,
2130 extack);
2131 if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX] ||
2132 !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
2133 return -EINVAL;
2134
2135 index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2136 device = ib_device_get_by_index(sock_net(skb->sk), index);
2137 if (!device)
2138 return -EINVAL;
2139
2140 port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2141 if (!rdma_is_port_valid(device, port)) {
2142 ret = -EINVAL;
2143 goto err_put_device;
2144 }
2145
2146 if (!tb[RDMA_NLDEV_ATTR_STAT_MODE] &&
2147 !tb[RDMA_NLDEV_ATTR_STAT_HWCOUNTERS]) {
2148 ret = -EINVAL;
2149 goto err_put_device;
2150 }
2151
2152 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2153 if (!msg) {
2154 ret = -ENOMEM;
2155 goto err_put_device;
2156 }
2157 nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2158 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
2159 RDMA_NLDEV_CMD_STAT_SET),
2160 0, 0);
2161 if (!nlh || fill_nldev_handle(msg, device) ||
2162 nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port)) {
2163 ret = -EMSGSIZE;
2164 goto err_free_msg;
2165 }
2166
2167 if (tb[RDMA_NLDEV_ATTR_STAT_MODE]) {
2168 ret = nldev_stat_set_mode_doit(msg, extack, tb, device, port);
2169 if (ret)
2170 goto err_free_msg;
2171 }
2172
2173 if (tb[RDMA_NLDEV_ATTR_STAT_HWCOUNTERS]) {
2174 ret = nldev_stat_set_counter_dynamic_doit(tb, device, port);
2175 if (ret)
2176 goto err_free_msg;
2177 }
2178
2179 nlmsg_end(msg, nlh);
2180 ib_device_put(device);
2181 return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2182
2183 err_free_msg:
2184 nlmsg_free(msg);
2185 err_put_device:
2186 ib_device_put(device);
2187 return ret;
2188 }
2189
nldev_stat_del_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)2190 static int nldev_stat_del_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
2191 struct netlink_ext_ack *extack)
2192 {
2193 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2194 struct ib_device *device;
2195 struct sk_buff *msg;
2196 u32 index, port, qpn, cntn;
2197 int ret;
2198
2199 ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2200 nldev_policy, extack);
2201 if (ret || !tb[RDMA_NLDEV_ATTR_STAT_RES] ||
2202 !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX] ||
2203 !tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID] ||
2204 !tb[RDMA_NLDEV_ATTR_RES_LQPN])
2205 return -EINVAL;
2206
2207 if (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES]) != RDMA_NLDEV_ATTR_RES_QP)
2208 return -EINVAL;
2209
2210 index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2211 device = ib_device_get_by_index(sock_net(skb->sk), index);
2212 if (!device)
2213 return -EINVAL;
2214
2215 port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2216 if (!rdma_is_port_valid(device, port)) {
2217 ret = -EINVAL;
2218 goto err;
2219 }
2220
2221 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2222 if (!msg) {
2223 ret = -ENOMEM;
2224 goto err;
2225 }
2226 nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2227 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
2228 RDMA_NLDEV_CMD_STAT_SET),
2229 0, 0);
2230 if (!nlh) {
2231 ret = -EMSGSIZE;
2232 goto err_fill;
2233 }
2234
2235 cntn = nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID]);
2236 qpn = nla_get_u32(tb[RDMA_NLDEV_ATTR_RES_LQPN]);
2237 if (fill_nldev_handle(msg, device) ||
2238 nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port) ||
2239 nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_COUNTER_ID, cntn) ||
2240 nla_put_u32(msg, RDMA_NLDEV_ATTR_RES_LQPN, qpn)) {
2241 ret = -EMSGSIZE;
2242 goto err_fill;
2243 }
2244
2245 ret = rdma_counter_unbind_qpn(device, port, qpn, cntn);
2246 if (ret)
2247 goto err_fill;
2248
2249 nlmsg_end(msg, nlh);
2250 ib_device_put(device);
2251 return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2252
2253 err_fill:
2254 nlmsg_free(msg);
2255 err:
2256 ib_device_put(device);
2257 return ret;
2258 }
2259
2260 static noinline_for_stack int
stat_get_doit_default_counter(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack,struct nlattr * tb[])2261 stat_get_doit_default_counter(struct sk_buff *skb, struct nlmsghdr *nlh,
2262 struct netlink_ext_ack *extack,
2263 struct nlattr *tb[])
2264 {
2265 struct rdma_hw_stats *stats;
2266 struct nlattr *table_attr;
2267 struct ib_device *device;
2268 int ret, num_cnts, i;
2269 struct sk_buff *msg;
2270 u32 index, port;
2271 u64 v;
2272
2273 if (!tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
2274 return -EINVAL;
2275
2276 index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2277 device = ib_device_get_by_index(sock_net(skb->sk), index);
2278 if (!device)
2279 return -EINVAL;
2280
2281 if (!device->ops.alloc_hw_port_stats || !device->ops.get_hw_stats) {
2282 ret = -EINVAL;
2283 goto err;
2284 }
2285
2286 port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2287 stats = ib_get_hw_stats_port(device, port);
2288 if (!stats) {
2289 ret = -EINVAL;
2290 goto err;
2291 }
2292
2293 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2294 if (!msg) {
2295 ret = -ENOMEM;
2296 goto err;
2297 }
2298
2299 nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2300 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
2301 RDMA_NLDEV_CMD_STAT_GET),
2302 0, 0);
2303
2304 if (!nlh || fill_nldev_handle(msg, device) ||
2305 nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port)) {
2306 ret = -EMSGSIZE;
2307 goto err_msg;
2308 }
2309
2310 mutex_lock(&stats->lock);
2311
2312 num_cnts = device->ops.get_hw_stats(device, stats, port, 0);
2313 if (num_cnts < 0) {
2314 ret = -EINVAL;
2315 goto err_stats;
2316 }
2317
2318 table_attr = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTERS);
2319 if (!table_attr) {
2320 ret = -EMSGSIZE;
2321 goto err_stats;
2322 }
2323 for (i = 0; i < num_cnts; i++) {
2324 if (test_bit(i, stats->is_disabled))
2325 continue;
2326
2327 v = stats->value[i] +
2328 rdma_counter_get_hwstat_value(device, port, i);
2329 if (rdma_nl_stat_hwcounter_entry(msg,
2330 stats->descs[i].name, v)) {
2331 ret = -EMSGSIZE;
2332 goto err_table;
2333 }
2334 }
2335 nla_nest_end(msg, table_attr);
2336
2337 mutex_unlock(&stats->lock);
2338 nlmsg_end(msg, nlh);
2339 ib_device_put(device);
2340 return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2341
2342 err_table:
2343 nla_nest_cancel(msg, table_attr);
2344 err_stats:
2345 mutex_unlock(&stats->lock);
2346 err_msg:
2347 nlmsg_free(msg);
2348 err:
2349 ib_device_put(device);
2350 return ret;
2351 }
2352
2353 static noinline_for_stack int
stat_get_doit_qp(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack,struct nlattr * tb[])2354 stat_get_doit_qp(struct sk_buff *skb, struct nlmsghdr *nlh,
2355 struct netlink_ext_ack *extack, struct nlattr *tb[])
2356
2357 {
2358 static enum rdma_nl_counter_mode mode;
2359 static enum rdma_nl_counter_mask mask;
2360 struct ib_device *device;
2361 struct sk_buff *msg;
2362 u32 index, port;
2363 int ret;
2364
2365 if (tb[RDMA_NLDEV_ATTR_STAT_COUNTER_ID])
2366 return nldev_res_get_counter_doit(skb, nlh, extack);
2367
2368 if (!tb[RDMA_NLDEV_ATTR_STAT_MODE] ||
2369 !tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
2370 return -EINVAL;
2371
2372 index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2373 device = ib_device_get_by_index(sock_net(skb->sk), index);
2374 if (!device)
2375 return -EINVAL;
2376
2377 port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2378 if (!rdma_is_port_valid(device, port)) {
2379 ret = -EINVAL;
2380 goto err;
2381 }
2382
2383 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2384 if (!msg) {
2385 ret = -ENOMEM;
2386 goto err;
2387 }
2388
2389 nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2390 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
2391 RDMA_NLDEV_CMD_STAT_GET),
2392 0, 0);
2393 if (!nlh) {
2394 ret = -EMSGSIZE;
2395 goto err_msg;
2396 }
2397
2398 ret = rdma_counter_get_mode(device, port, &mode, &mask);
2399 if (ret)
2400 goto err_msg;
2401
2402 if (fill_nldev_handle(msg, device) ||
2403 nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port) ||
2404 nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_MODE, mode)) {
2405 ret = -EMSGSIZE;
2406 goto err_msg;
2407 }
2408
2409 if ((mode == RDMA_COUNTER_MODE_AUTO) &&
2410 nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_AUTO_MODE_MASK, mask)) {
2411 ret = -EMSGSIZE;
2412 goto err_msg;
2413 }
2414
2415 nlmsg_end(msg, nlh);
2416 ib_device_put(device);
2417 return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2418
2419 err_msg:
2420 nlmsg_free(msg);
2421 err:
2422 ib_device_put(device);
2423 return ret;
2424 }
2425
nldev_stat_get_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)2426 static int nldev_stat_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
2427 struct netlink_ext_ack *extack)
2428 {
2429 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2430 int ret;
2431
2432 ret = __nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2433 nldev_policy, NL_VALIDATE_LIBERAL, extack);
2434 if (ret)
2435 return -EINVAL;
2436
2437 if (!tb[RDMA_NLDEV_ATTR_STAT_RES])
2438 return stat_get_doit_default_counter(skb, nlh, extack, tb);
2439
2440 switch (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES])) {
2441 case RDMA_NLDEV_ATTR_RES_QP:
2442 ret = stat_get_doit_qp(skb, nlh, extack, tb);
2443 break;
2444 case RDMA_NLDEV_ATTR_RES_MR:
2445 ret = res_get_common_doit(skb, nlh, extack, RDMA_RESTRACK_MR,
2446 fill_stat_mr_entry);
2447 break;
2448 default:
2449 ret = -EINVAL;
2450 break;
2451 }
2452
2453 return ret;
2454 }
2455
nldev_stat_get_dumpit(struct sk_buff * skb,struct netlink_callback * cb)2456 static int nldev_stat_get_dumpit(struct sk_buff *skb,
2457 struct netlink_callback *cb)
2458 {
2459 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2460 int ret;
2461
2462 ret = __nlmsg_parse(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2463 nldev_policy, NL_VALIDATE_LIBERAL, NULL);
2464 if (ret || !tb[RDMA_NLDEV_ATTR_STAT_RES])
2465 return -EINVAL;
2466
2467 switch (nla_get_u32(tb[RDMA_NLDEV_ATTR_STAT_RES])) {
2468 case RDMA_NLDEV_ATTR_RES_QP:
2469 ret = nldev_res_get_counter_dumpit(skb, cb);
2470 break;
2471 case RDMA_NLDEV_ATTR_RES_MR:
2472 ret = res_get_common_dumpit(skb, cb, RDMA_RESTRACK_MR,
2473 fill_stat_mr_entry);
2474 break;
2475 default:
2476 ret = -EINVAL;
2477 break;
2478 }
2479
2480 return ret;
2481 }
2482
nldev_stat_get_counter_status_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)2483 static int nldev_stat_get_counter_status_doit(struct sk_buff *skb,
2484 struct nlmsghdr *nlh,
2485 struct netlink_ext_ack *extack)
2486 {
2487 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX], *table, *entry;
2488 struct rdma_hw_stats *stats;
2489 struct ib_device *device;
2490 struct sk_buff *msg;
2491 u32 devid, port;
2492 int ret, i;
2493
2494 ret = __nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2495 nldev_policy, NL_VALIDATE_LIBERAL, extack);
2496 if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX] ||
2497 !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
2498 return -EINVAL;
2499
2500 devid = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2501 device = ib_device_get_by_index(sock_net(skb->sk), devid);
2502 if (!device)
2503 return -EINVAL;
2504
2505 port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
2506 if (!rdma_is_port_valid(device, port)) {
2507 ret = -EINVAL;
2508 goto err;
2509 }
2510
2511 stats = ib_get_hw_stats_port(device, port);
2512 if (!stats) {
2513 ret = -EINVAL;
2514 goto err;
2515 }
2516
2517 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2518 if (!msg) {
2519 ret = -ENOMEM;
2520 goto err;
2521 }
2522
2523 nlh = nlmsg_put(
2524 msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
2525 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_STAT_GET_STATUS),
2526 0, 0);
2527
2528 ret = -EMSGSIZE;
2529 if (!nlh || fill_nldev_handle(msg, device) ||
2530 nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port))
2531 goto err_msg;
2532
2533 table = nla_nest_start(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTERS);
2534 if (!table)
2535 goto err_msg;
2536
2537 mutex_lock(&stats->lock);
2538 for (i = 0; i < stats->num_counters; i++) {
2539 entry = nla_nest_start(msg,
2540 RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY);
2541 if (!entry)
2542 goto err_msg_table;
2543
2544 if (nla_put_string(msg,
2545 RDMA_NLDEV_ATTR_STAT_HWCOUNTER_ENTRY_NAME,
2546 stats->descs[i].name) ||
2547 nla_put_u32(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_INDEX, i))
2548 goto err_msg_entry;
2549
2550 if ((stats->descs[i].flags & IB_STAT_FLAG_OPTIONAL) &&
2551 (nla_put_u8(msg, RDMA_NLDEV_ATTR_STAT_HWCOUNTER_DYNAMIC,
2552 !test_bit(i, stats->is_disabled))))
2553 goto err_msg_entry;
2554
2555 nla_nest_end(msg, entry);
2556 }
2557 mutex_unlock(&stats->lock);
2558
2559 nla_nest_end(msg, table);
2560 nlmsg_end(msg, nlh);
2561 ib_device_put(device);
2562 return rdma_nl_unicast(sock_net(skb->sk), msg, NETLINK_CB(skb).portid);
2563
2564 err_msg_entry:
2565 nla_nest_cancel(msg, entry);
2566 err_msg_table:
2567 mutex_unlock(&stats->lock);
2568 nla_nest_cancel(msg, table);
2569 err_msg:
2570 nlmsg_free(msg);
2571 err:
2572 ib_device_put(device);
2573 return ret;
2574 }
2575
nldev_newdev(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)2576 static int nldev_newdev(struct sk_buff *skb, struct nlmsghdr *nlh,
2577 struct netlink_ext_ack *extack)
2578 {
2579 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2580 enum rdma_nl_dev_type type;
2581 struct ib_device *parent;
2582 char name[IFNAMSIZ] = {};
2583 u32 parentid;
2584 int ret;
2585
2586 ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2587 nldev_policy, extack);
2588 if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX] ||
2589 !tb[RDMA_NLDEV_ATTR_DEV_NAME] || !tb[RDMA_NLDEV_ATTR_DEV_TYPE])
2590 return -EINVAL;
2591
2592 nla_strscpy(name, tb[RDMA_NLDEV_ATTR_DEV_NAME], sizeof(name));
2593 type = nla_get_u8(tb[RDMA_NLDEV_ATTR_DEV_TYPE]);
2594 parentid = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2595 parent = ib_device_get_by_index(sock_net(skb->sk), parentid);
2596 if (!parent)
2597 return -EINVAL;
2598
2599 ret = ib_add_sub_device(parent, type, name);
2600 ib_device_put(parent);
2601
2602 return ret;
2603 }
2604
nldev_deldev(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)2605 static int nldev_deldev(struct sk_buff *skb, struct nlmsghdr *nlh,
2606 struct netlink_ext_ack *extack)
2607 {
2608 struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
2609 struct ib_device *device;
2610 u32 devid;
2611 int ret;
2612
2613 ret = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
2614 nldev_policy, extack);
2615 if (ret || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
2616 return -EINVAL;
2617
2618 devid = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
2619 device = ib_device_get_by_index(sock_net(skb->sk), devid);
2620 if (!device)
2621 return -EINVAL;
2622
2623 return ib_del_sub_device_and_put(device);
2624 }
2625
2626 static const struct rdma_nl_cbs nldev_cb_table[RDMA_NLDEV_NUM_OPS] = {
2627 [RDMA_NLDEV_CMD_GET] = {
2628 .doit = nldev_get_doit,
2629 .dump = nldev_get_dumpit,
2630 },
2631 [RDMA_NLDEV_CMD_GET_CHARDEV] = {
2632 .doit = nldev_get_chardev,
2633 },
2634 [RDMA_NLDEV_CMD_SET] = {
2635 .doit = nldev_set_doit,
2636 .flags = RDMA_NL_ADMIN_PERM,
2637 },
2638 [RDMA_NLDEV_CMD_NEWLINK] = {
2639 .doit = nldev_newlink,
2640 .flags = RDMA_NL_ADMIN_PERM,
2641 },
2642 [RDMA_NLDEV_CMD_DELLINK] = {
2643 .doit = nldev_dellink,
2644 .flags = RDMA_NL_ADMIN_PERM,
2645 },
2646 [RDMA_NLDEV_CMD_PORT_GET] = {
2647 .doit = nldev_port_get_doit,
2648 .dump = nldev_port_get_dumpit,
2649 },
2650 [RDMA_NLDEV_CMD_RES_GET] = {
2651 .doit = nldev_res_get_doit,
2652 .dump = nldev_res_get_dumpit,
2653 },
2654 [RDMA_NLDEV_CMD_RES_QP_GET] = {
2655 .doit = nldev_res_get_qp_doit,
2656 .dump = nldev_res_get_qp_dumpit,
2657 },
2658 [RDMA_NLDEV_CMD_RES_CM_ID_GET] = {
2659 .doit = nldev_res_get_cm_id_doit,
2660 .dump = nldev_res_get_cm_id_dumpit,
2661 },
2662 [RDMA_NLDEV_CMD_RES_CQ_GET] = {
2663 .doit = nldev_res_get_cq_doit,
2664 .dump = nldev_res_get_cq_dumpit,
2665 },
2666 [RDMA_NLDEV_CMD_RES_MR_GET] = {
2667 .doit = nldev_res_get_mr_doit,
2668 .dump = nldev_res_get_mr_dumpit,
2669 },
2670 [RDMA_NLDEV_CMD_RES_PD_GET] = {
2671 .doit = nldev_res_get_pd_doit,
2672 .dump = nldev_res_get_pd_dumpit,
2673 },
2674 [RDMA_NLDEV_CMD_RES_CTX_GET] = {
2675 .doit = nldev_res_get_ctx_doit,
2676 .dump = nldev_res_get_ctx_dumpit,
2677 },
2678 [RDMA_NLDEV_CMD_RES_SRQ_GET] = {
2679 .doit = nldev_res_get_srq_doit,
2680 .dump = nldev_res_get_srq_dumpit,
2681 },
2682 [RDMA_NLDEV_CMD_SYS_GET] = {
2683 .doit = nldev_sys_get_doit,
2684 },
2685 [RDMA_NLDEV_CMD_SYS_SET] = {
2686 .doit = nldev_set_sys_set_doit,
2687 .flags = RDMA_NL_ADMIN_PERM,
2688 },
2689 [RDMA_NLDEV_CMD_STAT_SET] = {
2690 .doit = nldev_stat_set_doit,
2691 .flags = RDMA_NL_ADMIN_PERM,
2692 },
2693 [RDMA_NLDEV_CMD_STAT_GET] = {
2694 .doit = nldev_stat_get_doit,
2695 .dump = nldev_stat_get_dumpit,
2696 },
2697 [RDMA_NLDEV_CMD_STAT_DEL] = {
2698 .doit = nldev_stat_del_doit,
2699 .flags = RDMA_NL_ADMIN_PERM,
2700 },
2701 [RDMA_NLDEV_CMD_RES_QP_GET_RAW] = {
2702 .doit = nldev_res_get_qp_raw_doit,
2703 .dump = nldev_res_get_qp_raw_dumpit,
2704 .flags = RDMA_NL_ADMIN_PERM,
2705 },
2706 [RDMA_NLDEV_CMD_RES_CQ_GET_RAW] = {
2707 .doit = nldev_res_get_cq_raw_doit,
2708 .dump = nldev_res_get_cq_raw_dumpit,
2709 .flags = RDMA_NL_ADMIN_PERM,
2710 },
2711 [RDMA_NLDEV_CMD_RES_MR_GET_RAW] = {
2712 .doit = nldev_res_get_mr_raw_doit,
2713 .dump = nldev_res_get_mr_raw_dumpit,
2714 .flags = RDMA_NL_ADMIN_PERM,
2715 },
2716 [RDMA_NLDEV_CMD_RES_SRQ_GET_RAW] = {
2717 .doit = nldev_res_get_srq_raw_doit,
2718 .dump = nldev_res_get_srq_raw_dumpit,
2719 .flags = RDMA_NL_ADMIN_PERM,
2720 },
2721 [RDMA_NLDEV_CMD_STAT_GET_STATUS] = {
2722 .doit = nldev_stat_get_counter_status_doit,
2723 },
2724 [RDMA_NLDEV_CMD_NEWDEV] = {
2725 .doit = nldev_newdev,
2726 .flags = RDMA_NL_ADMIN_PERM,
2727 },
2728 [RDMA_NLDEV_CMD_DELDEV] = {
2729 .doit = nldev_deldev,
2730 .flags = RDMA_NL_ADMIN_PERM,
2731 },
2732 };
2733
fill_mon_netdev_association(struct sk_buff * msg,struct ib_device * device,u32 port,const struct net * net)2734 static int fill_mon_netdev_association(struct sk_buff *msg,
2735 struct ib_device *device, u32 port,
2736 const struct net *net)
2737 {
2738 struct net_device *netdev = ib_device_get_netdev(device, port);
2739 int ret = 0;
2740
2741 if (netdev && !net_eq(dev_net(netdev), net))
2742 goto out;
2743
2744 ret = nla_put_u32(msg, RDMA_NLDEV_ATTR_DEV_INDEX, device->index);
2745 if (ret)
2746 goto out;
2747
2748 ret = nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_NAME,
2749 dev_name(&device->dev));
2750 if (ret)
2751 goto out;
2752
2753 ret = nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port);
2754 if (ret)
2755 goto out;
2756
2757 if (netdev) {
2758 ret = nla_put_u32(msg,
2759 RDMA_NLDEV_ATTR_NDEV_INDEX, netdev->ifindex);
2760 if (ret)
2761 goto out;
2762
2763 ret = nla_put_string(msg,
2764 RDMA_NLDEV_ATTR_NDEV_NAME, netdev->name);
2765 }
2766
2767 out:
2768 dev_put(netdev);
2769 return ret;
2770 }
2771
rdma_nl_notify_err_msg(struct ib_device * device,u32 port_num,enum rdma_nl_notify_event_type type)2772 static void rdma_nl_notify_err_msg(struct ib_device *device, u32 port_num,
2773 enum rdma_nl_notify_event_type type)
2774 {
2775 struct net_device *netdev;
2776
2777 switch (type) {
2778 case RDMA_REGISTER_EVENT:
2779 dev_warn_ratelimited(&device->dev,
2780 "Failed to send RDMA monitor register device event\n");
2781 break;
2782 case RDMA_UNREGISTER_EVENT:
2783 dev_warn_ratelimited(&device->dev,
2784 "Failed to send RDMA monitor unregister device event\n");
2785 break;
2786 case RDMA_NETDEV_ATTACH_EVENT:
2787 netdev = ib_device_get_netdev(device, port_num);
2788 dev_warn_ratelimited(&device->dev,
2789 "Failed to send RDMA monitor netdev attach event: port %d netdev %d\n",
2790 port_num, netdev->ifindex);
2791 dev_put(netdev);
2792 break;
2793 case RDMA_NETDEV_DETACH_EVENT:
2794 dev_warn_ratelimited(&device->dev,
2795 "Failed to send RDMA monitor netdev detach event: port %d\n",
2796 port_num);
2797 break;
2798 default:
2799 break;
2800 }
2801 }
2802
rdma_nl_notify_event(struct ib_device * device,u32 port_num,enum rdma_nl_notify_event_type type)2803 int rdma_nl_notify_event(struct ib_device *device, u32 port_num,
2804 enum rdma_nl_notify_event_type type)
2805 {
2806 struct sk_buff *skb;
2807 int ret = -EMSGSIZE;
2808 struct net *net;
2809 void *nlh;
2810
2811 net = read_pnet(&device->coredev.rdma_net);
2812 if (!net)
2813 return -EINVAL;
2814
2815 skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
2816 if (!skb)
2817 return -ENOMEM;
2818 nlh = nlmsg_put(skb, 0, 0,
2819 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_MONITOR),
2820 0, 0);
2821 if (!nlh)
2822 goto err_free;
2823
2824 switch (type) {
2825 case RDMA_REGISTER_EVENT:
2826 case RDMA_UNREGISTER_EVENT:
2827 ret = fill_nldev_handle(skb, device);
2828 if (ret)
2829 goto err_free;
2830 break;
2831 case RDMA_NETDEV_ATTACH_EVENT:
2832 case RDMA_NETDEV_DETACH_EVENT:
2833 ret = fill_mon_netdev_association(skb, device,
2834 port_num, net);
2835 if (ret)
2836 goto err_free;
2837 break;
2838 default:
2839 break;
2840 }
2841
2842 ret = nla_put_u8(skb, RDMA_NLDEV_ATTR_EVENT_TYPE, type);
2843 if (ret)
2844 goto err_free;
2845
2846 nlmsg_end(skb, nlh);
2847 ret = rdma_nl_multicast(net, skb, RDMA_NL_GROUP_NOTIFY, GFP_KERNEL);
2848 if (ret && ret != -ESRCH) {
2849 skb = NULL; /* skb is freed in the netlink send-op handling */
2850 goto err_free;
2851 }
2852 return 0;
2853
2854 err_free:
2855 rdma_nl_notify_err_msg(device, port_num, type);
2856 nlmsg_free(skb);
2857 return ret;
2858 }
2859
nldev_init(void)2860 void __init nldev_init(void)
2861 {
2862 rdma_nl_register(RDMA_NL_NLDEV, nldev_cb_table);
2863 }
2864
nldev_exit(void)2865 void nldev_exit(void)
2866 {
2867 rdma_nl_unregister(RDMA_NL_NLDEV);
2868 }
2869
2870 MODULE_ALIAS_RDMA_NETLINK(RDMA_NL_NLDEV, 5);
2871