Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Shared Memory Communications over RDMA (SMC-R) and RoCE
4 *
5 * Generic netlink support functions to configure an SMC-R PNET table
6 *
7 * Copyright IBM Corp. 2016
8 *
9 * Author(s): Thomas Richter <tmricht@linux.vnet.ibm.com>
10 */
11
12#include <linux/module.h>
13#include <linux/list.h>
14#include <linux/ctype.h>
15#include <linux/mutex.h>
16#include <net/netlink.h>
17#include <net/genetlink.h>
18
19#include <uapi/linux/if.h>
20#include <uapi/linux/smc.h>
21
22#include <rdma/ib_verbs.h>
23
24#include <net/netns/generic.h>
25#include "smc_netns.h"
26
27#include "smc_pnet.h"
28#include "smc_ib.h"
29#include "smc_ism.h"
30#include "smc_core.h"
31
32static struct net_device *__pnet_find_base_ndev(struct net_device *ndev);
33static struct net_device *pnet_find_base_ndev(struct net_device *ndev);
34
35static const struct nla_policy smc_pnet_policy[SMC_PNETID_MAX + 1] = {
36 [SMC_PNETID_NAME] = {
37 .type = NLA_NUL_STRING,
38 .len = SMC_MAX_PNETID_LEN
39 },
40 [SMC_PNETID_ETHNAME] = {
41 .type = NLA_NUL_STRING,
42 .len = IFNAMSIZ - 1
43 },
44 [SMC_PNETID_IBNAME] = {
45 .type = NLA_NUL_STRING,
46 .len = IB_DEVICE_NAME_MAX - 1
47 },
48 [SMC_PNETID_IBPORT] = { .type = NLA_U8 }
49};
50
51static struct genl_family smc_pnet_nl_family;
52
53enum smc_pnet_nametype {
54 SMC_PNET_ETH = 1,
55 SMC_PNET_IB = 2,
56};
57
58/* pnet entry stored in pnet table */
59struct smc_pnetentry {
60 struct list_head list;
61 char pnet_name[SMC_MAX_PNETID_LEN + 1];
62 enum smc_pnet_nametype type;
63 union {
64 struct {
65 char eth_name[IFNAMSIZ + 1];
66 struct net_device *ndev;
67 netdevice_tracker dev_tracker;
68 };
69 struct {
70 char ib_name[IB_DEVICE_NAME_MAX + 1];
71 u8 ib_port;
72 };
73 };
74};
75
76/* Check if the pnetid is set */
77bool smc_pnet_is_pnetid_set(u8 *pnetid)
78{
79 if (pnetid[0] == 0 || pnetid[0] == _S)
80 return false;
81 return true;
82}
83
84/* Check if two given pnetids match */
85static bool smc_pnet_match(u8 *pnetid1, u8 *pnetid2)
86{
87 int i;
88
89 for (i = 0; i < SMC_MAX_PNETID_LEN; i++) {
90 if ((pnetid1[i] == 0 || pnetid1[i] == _S) &&
91 (pnetid2[i] == 0 || pnetid2[i] == _S))
92 break;
93 if (pnetid1[i] != pnetid2[i])
94 return false;
95 }
96 return true;
97}
98
99/* Remove a pnetid from the pnet table.
100 */
101static int smc_pnet_remove_by_pnetid(struct net *net, char *pnet_name)
102{
103 struct smc_pnetentry *pnetelem, *tmp_pe;
104 struct smc_pnettable *pnettable;
105 struct smc_ib_device *ibdev;
106 struct smcd_dev *smcd;
107 struct smc_net *sn;
108 int rc = -ENOENT;
109 int ibport;
110
111 /* get pnettable for namespace */
112 sn = net_generic(net, smc_net_id);
113 pnettable = &sn->pnettable;
114
115 /* remove table entry */
116 mutex_lock(&pnettable->lock);
117 list_for_each_entry_safe(pnetelem, tmp_pe, &pnettable->pnetlist,
118 list) {
119 if (!pnet_name ||
120 smc_pnet_match(pnetelem->pnet_name, pnet_name)) {
121 list_del(&pnetelem->list);
122 if (pnetelem->type == SMC_PNET_ETH && pnetelem->ndev) {
123 netdev_put(pnetelem->ndev,
124 &pnetelem->dev_tracker);
125 pr_warn_ratelimited("smc: net device %s "
126 "erased user defined "
127 "pnetid %.16s\n",
128 pnetelem->eth_name,
129 pnetelem->pnet_name);
130 }
131 kfree(pnetelem);
132 rc = 0;
133 }
134 }
135 mutex_unlock(&pnettable->lock);
136
137 /* if this is not the initial namespace, stop here */
138 if (net != &init_net)
139 return rc;
140
141 /* remove ib devices */
142 mutex_lock(&smc_ib_devices.mutex);
143 list_for_each_entry(ibdev, &smc_ib_devices.list, list) {
144 for (ibport = 0; ibport < SMC_MAX_PORTS; ibport++) {
145 if (ibdev->pnetid_by_user[ibport] &&
146 (!pnet_name ||
147 smc_pnet_match(pnet_name,
148 ibdev->pnetid[ibport]))) {
149 pr_warn_ratelimited("smc: ib device %s ibport "
150 "%d erased user defined "
151 "pnetid %.16s\n",
152 ibdev->ibdev->name,
153 ibport + 1,
154 ibdev->pnetid[ibport]);
155 memset(ibdev->pnetid[ibport], 0,
156 SMC_MAX_PNETID_LEN);
157 ibdev->pnetid_by_user[ibport] = false;
158 rc = 0;
159 }
160 }
161 }
162 mutex_unlock(&smc_ib_devices.mutex);
163 /* remove smcd devices */
164 mutex_lock(&smcd_dev_list.mutex);
165 list_for_each_entry(smcd, &smcd_dev_list.list, list) {
166 if (smcd->pnetid_by_user &&
167 (!pnet_name ||
168 smc_pnet_match(pnet_name, smcd->pnetid))) {
169 pr_warn_ratelimited("smc: smcd device %s "
170 "erased user defined pnetid "
171 "%.16s\n",
172 dev_name(smcd->ops->get_dev(smcd)),
173 smcd->pnetid);
174 memset(smcd->pnetid, 0, SMC_MAX_PNETID_LEN);
175 smcd->pnetid_by_user = false;
176 rc = 0;
177 }
178 }
179 mutex_unlock(&smcd_dev_list.mutex);
180 return rc;
181}
182
183/* Add the reference to a given network device to the pnet table.
184 */
185static int smc_pnet_add_by_ndev(struct net_device *ndev)
186{
187 struct smc_pnetentry *pnetelem, *tmp_pe;
188 struct smc_pnettable *pnettable;
189 struct net *net = dev_net(ndev);
190 struct smc_net *sn;
191 int rc = -ENOENT;
192
193 /* get pnettable for namespace */
194 sn = net_generic(net, smc_net_id);
195 pnettable = &sn->pnettable;
196
197 mutex_lock(&pnettable->lock);
198 list_for_each_entry_safe(pnetelem, tmp_pe, &pnettable->pnetlist, list) {
199 if (pnetelem->type == SMC_PNET_ETH && !pnetelem->ndev &&
200 !strncmp(pnetelem->eth_name, ndev->name, IFNAMSIZ)) {
201 netdev_hold(ndev, &pnetelem->dev_tracker, GFP_ATOMIC);
202 pnetelem->ndev = ndev;
203 rc = 0;
204 pr_warn_ratelimited("smc: adding net device %s with "
205 "user defined pnetid %.16s\n",
206 pnetelem->eth_name,
207 pnetelem->pnet_name);
208 break;
209 }
210 }
211 mutex_unlock(&pnettable->lock);
212 return rc;
213}
214
215/* Remove the reference to a given network device from the pnet table.
216 */
217static int smc_pnet_remove_by_ndev(struct net_device *ndev)
218{
219 struct smc_pnetentry *pnetelem, *tmp_pe;
220 struct smc_pnettable *pnettable;
221 struct net *net = dev_net(ndev);
222 struct smc_net *sn;
223 int rc = -ENOENT;
224
225 /* get pnettable for namespace */
226 sn = net_generic(net, smc_net_id);
227 pnettable = &sn->pnettable;
228
229 mutex_lock(&pnettable->lock);
230 list_for_each_entry_safe(pnetelem, tmp_pe, &pnettable->pnetlist, list) {
231 if (pnetelem->type == SMC_PNET_ETH && pnetelem->ndev == ndev) {
232 netdev_put(pnetelem->ndev, &pnetelem->dev_tracker);
233 pnetelem->ndev = NULL;
234 rc = 0;
235 pr_warn_ratelimited("smc: removing net device %s with "
236 "user defined pnetid %.16s\n",
237 pnetelem->eth_name,
238 pnetelem->pnet_name);
239 break;
240 }
241 }
242 mutex_unlock(&pnettable->lock);
243 return rc;
244}
245
246/* Apply pnetid to ib device when no pnetid is set.
247 */
248static bool smc_pnet_apply_ib(struct smc_ib_device *ib_dev, u8 ib_port,
249 char *pnet_name)
250{
251 bool applied = false;
252
253 mutex_lock(&smc_ib_devices.mutex);
254 if (!smc_pnet_is_pnetid_set(ib_dev->pnetid[ib_port - 1])) {
255 memcpy(ib_dev->pnetid[ib_port - 1], pnet_name,
256 SMC_MAX_PNETID_LEN);
257 ib_dev->pnetid_by_user[ib_port - 1] = true;
258 applied = true;
259 }
260 mutex_unlock(&smc_ib_devices.mutex);
261 return applied;
262}
263
264/* Apply pnetid to smcd device when no pnetid is set.
265 */
266static bool smc_pnet_apply_smcd(struct smcd_dev *smcd_dev, char *pnet_name)
267{
268 bool applied = false;
269
270 mutex_lock(&smcd_dev_list.mutex);
271 if (!smc_pnet_is_pnetid_set(smcd_dev->pnetid)) {
272 memcpy(smcd_dev->pnetid, pnet_name, SMC_MAX_PNETID_LEN);
273 smcd_dev->pnetid_by_user = true;
274 applied = true;
275 }
276 mutex_unlock(&smcd_dev_list.mutex);
277 return applied;
278}
279
280/* The limit for pnetid is 16 characters.
281 * Valid characters should be (single-byte character set) a-z, A-Z, 0-9.
282 * Lower case letters are converted to upper case.
283 * Interior blanks should not be used.
284 */
285static bool smc_pnetid_valid(const char *pnet_name, char *pnetid)
286{
287 char *bf = skip_spaces(pnet_name);
288 size_t len = strlen(bf);
289 char *end = bf + len;
290
291 if (!len)
292 return false;
293 while (--end >= bf && isspace(*end))
294 ;
295 if (end - bf >= SMC_MAX_PNETID_LEN)
296 return false;
297 while (bf <= end) {
298 if (!isalnum(*bf))
299 return false;
300 *pnetid++ = islower(*bf) ? toupper(*bf) : *bf;
301 bf++;
302 }
303 *pnetid = '\0';
304 return true;
305}
306
307/* Find an infiniband device by a given name. The device might not exist. */
308static struct smc_ib_device *smc_pnet_find_ib(char *ib_name)
309{
310 struct smc_ib_device *ibdev;
311
312 mutex_lock(&smc_ib_devices.mutex);
313 list_for_each_entry(ibdev, &smc_ib_devices.list, list) {
314 if (!strncmp(ibdev->ibdev->name, ib_name,
315 sizeof(ibdev->ibdev->name)) ||
316 (ibdev->ibdev->dev.parent &&
317 !strncmp(dev_name(ibdev->ibdev->dev.parent), ib_name,
318 IB_DEVICE_NAME_MAX - 1))) {
319 goto out;
320 }
321 }
322 ibdev = NULL;
323out:
324 mutex_unlock(&smc_ib_devices.mutex);
325 return ibdev;
326}
327
328/* Find an smcd device by a given name. The device might not exist. */
329static struct smcd_dev *smc_pnet_find_smcd(char *smcd_name)
330{
331 struct smcd_dev *smcd_dev;
332
333 mutex_lock(&smcd_dev_list.mutex);
334 list_for_each_entry(smcd_dev, &smcd_dev_list.list, list) {
335 if (!strncmp(dev_name(smcd_dev->ops->get_dev(smcd_dev)),
336 smcd_name, IB_DEVICE_NAME_MAX - 1))
337 goto out;
338 }
339 smcd_dev = NULL;
340out:
341 mutex_unlock(&smcd_dev_list.mutex);
342 return smcd_dev;
343}
344
345static int smc_pnet_add_eth(struct smc_pnettable *pnettable, struct net *net,
346 char *eth_name, char *pnet_name)
347{
348 struct smc_pnetentry *tmp_pe, *new_pe;
349 struct net_device *ndev, *base_ndev;
350 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
351 bool new_netdev;
352 int rc;
353
354 /* check if (base) netdev already has a pnetid. If there is one, we do
355 * not want to add a pnet table entry
356 */
357 rc = -EEXIST;
358 ndev = dev_get_by_name(net, eth_name); /* dev_hold() */
359 if (ndev) {
360 base_ndev = pnet_find_base_ndev(ndev);
361 if (!smc_pnetid_by_dev_port(base_ndev->dev.parent,
362 base_ndev->dev_port, ndev_pnetid))
363 goto out_put;
364 }
365
366 /* add a new netdev entry to the pnet table if there isn't one */
367 rc = -ENOMEM;
368 new_pe = kzalloc(sizeof(*new_pe), GFP_KERNEL);
369 if (!new_pe)
370 goto out_put;
371 new_pe->type = SMC_PNET_ETH;
372 memcpy(new_pe->pnet_name, pnet_name, SMC_MAX_PNETID_LEN);
373 strncpy(new_pe->eth_name, eth_name, IFNAMSIZ);
374 rc = -EEXIST;
375 new_netdev = true;
376 mutex_lock(&pnettable->lock);
377 list_for_each_entry(tmp_pe, &pnettable->pnetlist, list) {
378 if (tmp_pe->type == SMC_PNET_ETH &&
379 !strncmp(tmp_pe->eth_name, eth_name, IFNAMSIZ)) {
380 new_netdev = false;
381 break;
382 }
383 }
384 if (new_netdev) {
385 if (ndev) {
386 new_pe->ndev = ndev;
387 netdev_tracker_alloc(ndev, &new_pe->dev_tracker,
388 GFP_ATOMIC);
389 }
390 list_add_tail(&new_pe->list, &pnettable->pnetlist);
391 mutex_unlock(&pnettable->lock);
392 } else {
393 mutex_unlock(&pnettable->lock);
394 kfree(new_pe);
395 goto out_put;
396 }
397 if (ndev)
398 pr_warn_ratelimited("smc: net device %s "
399 "applied user defined pnetid %.16s\n",
400 new_pe->eth_name, new_pe->pnet_name);
401 return 0;
402
403out_put:
404 dev_put(ndev);
405 return rc;
406}
407
408static int smc_pnet_add_ib(struct smc_pnettable *pnettable, char *ib_name,
409 u8 ib_port, char *pnet_name)
410{
411 struct smc_pnetentry *tmp_pe, *new_pe;
412 struct smc_ib_device *ib_dev;
413 bool smcddev_applied = true;
414 bool ibdev_applied = true;
415 struct smcd_dev *smcd;
416 struct device *dev;
417 bool new_ibdev;
418
419 /* try to apply the pnetid to active devices */
420 ib_dev = smc_pnet_find_ib(ib_name);
421 if (ib_dev) {
422 ibdev_applied = smc_pnet_apply_ib(ib_dev, ib_port, pnet_name);
423 if (ibdev_applied)
424 pr_warn_ratelimited("smc: ib device %s ibport %d "
425 "applied user defined pnetid "
426 "%.16s\n", ib_dev->ibdev->name,
427 ib_port,
428 ib_dev->pnetid[ib_port - 1]);
429 }
430 smcd = smc_pnet_find_smcd(ib_name);
431 if (smcd) {
432 smcddev_applied = smc_pnet_apply_smcd(smcd, pnet_name);
433 if (smcddev_applied) {
434 dev = smcd->ops->get_dev(smcd);
435 pr_warn_ratelimited("smc: smcd device %s "
436 "applied user defined pnetid "
437 "%.16s\n", dev_name(dev),
438 smcd->pnetid);
439 }
440 }
441 /* Apply fails when a device has a hardware-defined pnetid set, do not
442 * add a pnet table entry in that case.
443 */
444 if (!ibdev_applied || !smcddev_applied)
445 return -EEXIST;
446
447 /* add a new ib entry to the pnet table if there isn't one */
448 new_pe = kzalloc(sizeof(*new_pe), GFP_KERNEL);
449 if (!new_pe)
450 return -ENOMEM;
451 new_pe->type = SMC_PNET_IB;
452 memcpy(new_pe->pnet_name, pnet_name, SMC_MAX_PNETID_LEN);
453 strncpy(new_pe->ib_name, ib_name, IB_DEVICE_NAME_MAX);
454 new_pe->ib_port = ib_port;
455
456 new_ibdev = true;
457 mutex_lock(&pnettable->lock);
458 list_for_each_entry(tmp_pe, &pnettable->pnetlist, list) {
459 if (tmp_pe->type == SMC_PNET_IB &&
460 !strncmp(tmp_pe->ib_name, ib_name, IB_DEVICE_NAME_MAX)) {
461 new_ibdev = false;
462 break;
463 }
464 }
465 if (new_ibdev) {
466 list_add_tail(&new_pe->list, &pnettable->pnetlist);
467 mutex_unlock(&pnettable->lock);
468 } else {
469 mutex_unlock(&pnettable->lock);
470 kfree(new_pe);
471 }
472 return (new_ibdev) ? 0 : -EEXIST;
473}
474
475/* Append a pnetid to the end of the pnet table if not already on this list.
476 */
477static int smc_pnet_enter(struct net *net, struct nlattr *tb[])
478{
479 char pnet_name[SMC_MAX_PNETID_LEN + 1];
480 struct smc_pnettable *pnettable;
481 bool new_netdev = false;
482 bool new_ibdev = false;
483 struct smc_net *sn;
484 u8 ibport = 1;
485 char *string;
486 int rc;
487
488 /* get pnettable for namespace */
489 sn = net_generic(net, smc_net_id);
490 pnettable = &sn->pnettable;
491
492 rc = -EINVAL;
493 if (!tb[SMC_PNETID_NAME])
494 goto error;
495 string = (char *)nla_data(tb[SMC_PNETID_NAME]);
496 if (!smc_pnetid_valid(string, pnet_name))
497 goto error;
498
499 if (tb[SMC_PNETID_ETHNAME]) {
500 string = (char *)nla_data(tb[SMC_PNETID_ETHNAME]);
501 rc = smc_pnet_add_eth(pnettable, net, string, pnet_name);
502 if (!rc)
503 new_netdev = true;
504 else if (rc != -EEXIST)
505 goto error;
506 }
507
508 /* if this is not the initial namespace, stop here */
509 if (net != &init_net)
510 return new_netdev ? 0 : -EEXIST;
511
512 rc = -EINVAL;
513 if (tb[SMC_PNETID_IBNAME]) {
514 string = (char *)nla_data(tb[SMC_PNETID_IBNAME]);
515 string = strim(string);
516 if (tb[SMC_PNETID_IBPORT]) {
517 ibport = nla_get_u8(tb[SMC_PNETID_IBPORT]);
518 if (ibport < 1 || ibport > SMC_MAX_PORTS)
519 goto error;
520 }
521 rc = smc_pnet_add_ib(pnettable, string, ibport, pnet_name);
522 if (!rc)
523 new_ibdev = true;
524 else if (rc != -EEXIST)
525 goto error;
526 }
527 return (new_netdev || new_ibdev) ? 0 : -EEXIST;
528
529error:
530 return rc;
531}
532
533/* Convert an smc_pnetentry to a netlink attribute sequence */
534static int smc_pnet_set_nla(struct sk_buff *msg,
535 struct smc_pnetentry *pnetelem)
536{
537 if (nla_put_string(msg, SMC_PNETID_NAME, pnetelem->pnet_name))
538 return -1;
539 if (pnetelem->type == SMC_PNET_ETH) {
540 if (nla_put_string(msg, SMC_PNETID_ETHNAME,
541 pnetelem->eth_name))
542 return -1;
543 } else {
544 if (nla_put_string(msg, SMC_PNETID_ETHNAME, "n/a"))
545 return -1;
546 }
547 if (pnetelem->type == SMC_PNET_IB) {
548 if (nla_put_string(msg, SMC_PNETID_IBNAME, pnetelem->ib_name) ||
549 nla_put_u8(msg, SMC_PNETID_IBPORT, pnetelem->ib_port))
550 return -1;
551 } else {
552 if (nla_put_string(msg, SMC_PNETID_IBNAME, "n/a") ||
553 nla_put_u8(msg, SMC_PNETID_IBPORT, 0xff))
554 return -1;
555 }
556
557 return 0;
558}
559
560static int smc_pnet_add(struct sk_buff *skb, struct genl_info *info)
561{
562 struct net *net = genl_info_net(info);
563
564 return smc_pnet_enter(net, info->attrs);
565}
566
567static int smc_pnet_del(struct sk_buff *skb, struct genl_info *info)
568{
569 struct net *net = genl_info_net(info);
570
571 if (!info->attrs[SMC_PNETID_NAME])
572 return -EINVAL;
573 return smc_pnet_remove_by_pnetid(net,
574 (char *)nla_data(info->attrs[SMC_PNETID_NAME]));
575}
576
577static int smc_pnet_dump_start(struct netlink_callback *cb)
578{
579 cb->args[0] = 0;
580 return 0;
581}
582
583static int smc_pnet_dumpinfo(struct sk_buff *skb,
584 u32 portid, u32 seq, u32 flags,
585 struct smc_pnetentry *pnetelem)
586{
587 void *hdr;
588
589 hdr = genlmsg_put(skb, portid, seq, &smc_pnet_nl_family,
590 flags, SMC_PNETID_GET);
591 if (!hdr)
592 return -ENOMEM;
593 if (smc_pnet_set_nla(skb, pnetelem) < 0) {
594 genlmsg_cancel(skb, hdr);
595 return -EMSGSIZE;
596 }
597 genlmsg_end(skb, hdr);
598 return 0;
599}
600
601static int _smc_pnet_dump(struct net *net, struct sk_buff *skb, u32 portid,
602 u32 seq, u8 *pnetid, int start_idx)
603{
604 struct smc_pnettable *pnettable;
605 struct smc_pnetentry *pnetelem;
606 struct smc_net *sn;
607 int idx = 0;
608
609 /* get pnettable for namespace */
610 sn = net_generic(net, smc_net_id);
611 pnettable = &sn->pnettable;
612
613 /* dump pnettable entries */
614 mutex_lock(&pnettable->lock);
615 list_for_each_entry(pnetelem, &pnettable->pnetlist, list) {
616 if (pnetid && !smc_pnet_match(pnetelem->pnet_name, pnetid))
617 continue;
618 if (idx++ < start_idx)
619 continue;
620 /* if this is not the initial namespace, dump only netdev */
621 if (net != &init_net && pnetelem->type != SMC_PNET_ETH)
622 continue;
623 if (smc_pnet_dumpinfo(skb, portid, seq, NLM_F_MULTI,
624 pnetelem)) {
625 --idx;
626 break;
627 }
628 }
629 mutex_unlock(&pnettable->lock);
630 return idx;
631}
632
633static int smc_pnet_dump(struct sk_buff *skb, struct netlink_callback *cb)
634{
635 struct net *net = sock_net(skb->sk);
636 int idx;
637
638 idx = _smc_pnet_dump(net, skb, NETLINK_CB(cb->skb).portid,
639 cb->nlh->nlmsg_seq, NULL, cb->args[0]);
640
641 cb->args[0] = idx;
642 return skb->len;
643}
644
645/* Retrieve one PNETID entry */
646static int smc_pnet_get(struct sk_buff *skb, struct genl_info *info)
647{
648 struct net *net = genl_info_net(info);
649 struct sk_buff *msg;
650 void *hdr;
651
652 if (!info->attrs[SMC_PNETID_NAME])
653 return -EINVAL;
654
655 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
656 if (!msg)
657 return -ENOMEM;
658
659 _smc_pnet_dump(net, msg, info->snd_portid, info->snd_seq,
660 nla_data(info->attrs[SMC_PNETID_NAME]), 0);
661
662 /* finish multi part message and send it */
663 hdr = nlmsg_put(msg, info->snd_portid, info->snd_seq, NLMSG_DONE, 0,
664 NLM_F_MULTI);
665 if (!hdr) {
666 nlmsg_free(msg);
667 return -EMSGSIZE;
668 }
669 return genlmsg_reply(msg, info);
670}
671
672/* Remove and delete all pnetids from pnet table.
673 */
674static int smc_pnet_flush(struct sk_buff *skb, struct genl_info *info)
675{
676 struct net *net = genl_info_net(info);
677
678 smc_pnet_remove_by_pnetid(net, NULL);
679 return 0;
680}
681
682/* SMC_PNETID generic netlink operation definition */
683static const struct genl_ops smc_pnet_ops[] = {
684 {
685 .cmd = SMC_PNETID_GET,
686 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
687 /* can be retrieved by unprivileged users */
688 .doit = smc_pnet_get,
689 .dumpit = smc_pnet_dump,
690 .start = smc_pnet_dump_start
691 },
692 {
693 .cmd = SMC_PNETID_ADD,
694 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
695 .flags = GENL_ADMIN_PERM,
696 .doit = smc_pnet_add
697 },
698 {
699 .cmd = SMC_PNETID_DEL,
700 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
701 .flags = GENL_ADMIN_PERM,
702 .doit = smc_pnet_del
703 },
704 {
705 .cmd = SMC_PNETID_FLUSH,
706 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
707 .flags = GENL_ADMIN_PERM,
708 .doit = smc_pnet_flush
709 }
710};
711
712/* SMC_PNETID family definition */
713static struct genl_family smc_pnet_nl_family __ro_after_init = {
714 .hdrsize = 0,
715 .name = SMCR_GENL_FAMILY_NAME,
716 .version = SMCR_GENL_FAMILY_VERSION,
717 .maxattr = SMC_PNETID_MAX,
718 .policy = smc_pnet_policy,
719 .netnsok = true,
720 .module = THIS_MODULE,
721 .ops = smc_pnet_ops,
722 .n_ops = ARRAY_SIZE(smc_pnet_ops),
723 .resv_start_op = SMC_PNETID_FLUSH + 1,
724};
725
726bool smc_pnet_is_ndev_pnetid(struct net *net, u8 *pnetid)
727{
728 struct smc_net *sn = net_generic(net, smc_net_id);
729 struct smc_pnetids_ndev_entry *pe;
730 bool rc = false;
731
732 read_lock(&sn->pnetids_ndev.lock);
733 list_for_each_entry(pe, &sn->pnetids_ndev.list, list) {
734 if (smc_pnet_match(pnetid, pe->pnetid)) {
735 rc = true;
736 goto unlock;
737 }
738 }
739
740unlock:
741 read_unlock(&sn->pnetids_ndev.lock);
742 return rc;
743}
744
745static int smc_pnet_add_pnetid(struct net *net, u8 *pnetid)
746{
747 struct smc_net *sn = net_generic(net, smc_net_id);
748 struct smc_pnetids_ndev_entry *pe, *pi;
749
750 pe = kzalloc(sizeof(*pe), GFP_KERNEL);
751 if (!pe)
752 return -ENOMEM;
753
754 write_lock(&sn->pnetids_ndev.lock);
755 list_for_each_entry(pi, &sn->pnetids_ndev.list, list) {
756 if (smc_pnet_match(pnetid, pi->pnetid)) {
757 refcount_inc(&pi->refcnt);
758 kfree(pe);
759 goto unlock;
760 }
761 }
762 refcount_set(&pe->refcnt, 1);
763 memcpy(pe->pnetid, pnetid, SMC_MAX_PNETID_LEN);
764 list_add_tail(&pe->list, &sn->pnetids_ndev.list);
765
766unlock:
767 write_unlock(&sn->pnetids_ndev.lock);
768 return 0;
769}
770
771static void smc_pnet_remove_pnetid(struct net *net, u8 *pnetid)
772{
773 struct smc_net *sn = net_generic(net, smc_net_id);
774 struct smc_pnetids_ndev_entry *pe, *pe2;
775
776 write_lock(&sn->pnetids_ndev.lock);
777 list_for_each_entry_safe(pe, pe2, &sn->pnetids_ndev.list, list) {
778 if (smc_pnet_match(pnetid, pe->pnetid)) {
779 if (refcount_dec_and_test(&pe->refcnt)) {
780 list_del(&pe->list);
781 kfree(pe);
782 }
783 break;
784 }
785 }
786 write_unlock(&sn->pnetids_ndev.lock);
787}
788
789static void smc_pnet_add_base_pnetid(struct net *net, struct net_device *dev,
790 u8 *ndev_pnetid)
791{
792 struct net_device *base_dev;
793
794 base_dev = __pnet_find_base_ndev(dev);
795 if (base_dev->flags & IFF_UP &&
796 !smc_pnetid_by_dev_port(base_dev->dev.parent, base_dev->dev_port,
797 ndev_pnetid)) {
798 /* add to PNETIDs list */
799 smc_pnet_add_pnetid(net, ndev_pnetid);
800 }
801}
802
803/* create initial list of netdevice pnetids */
804static void smc_pnet_create_pnetids_list(struct net *net)
805{
806 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
807 struct net_device *dev;
808
809 /* Newly created netns do not have devices.
810 * Do not even acquire rtnl.
811 */
812 if (list_empty(&net->dev_base_head))
813 return;
814
815 /* Note: This might not be needed, because smc_pnet_netdev_event()
816 * is also calling smc_pnet_add_base_pnetid() when handling
817 * NETDEV_UP event.
818 */
819 rtnl_lock();
820 for_each_netdev(net, dev)
821 smc_pnet_add_base_pnetid(net, dev, ndev_pnetid);
822 rtnl_unlock();
823}
824
825/* clean up list of netdevice pnetids */
826static void smc_pnet_destroy_pnetids_list(struct net *net)
827{
828 struct smc_net *sn = net_generic(net, smc_net_id);
829 struct smc_pnetids_ndev_entry *pe, *temp_pe;
830
831 write_lock(&sn->pnetids_ndev.lock);
832 list_for_each_entry_safe(pe, temp_pe, &sn->pnetids_ndev.list, list) {
833 list_del(&pe->list);
834 kfree(pe);
835 }
836 write_unlock(&sn->pnetids_ndev.lock);
837}
838
839static int smc_pnet_netdev_event(struct notifier_block *this,
840 unsigned long event, void *ptr)
841{
842 struct net_device *event_dev = netdev_notifier_info_to_dev(ptr);
843 struct net *net = dev_net(event_dev);
844 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
845
846 switch (event) {
847 case NETDEV_REBOOT:
848 case NETDEV_UNREGISTER:
849 smc_pnet_remove_by_ndev(event_dev);
850 smc_ib_ndev_change(event_dev, event);
851 return NOTIFY_OK;
852 case NETDEV_REGISTER:
853 smc_pnet_add_by_ndev(event_dev);
854 smc_ib_ndev_change(event_dev, event);
855 return NOTIFY_OK;
856 case NETDEV_UP:
857 smc_pnet_add_base_pnetid(net, event_dev, ndev_pnetid);
858 return NOTIFY_OK;
859 case NETDEV_DOWN:
860 event_dev = __pnet_find_base_ndev(event_dev);
861 if (!smc_pnetid_by_dev_port(event_dev->dev.parent,
862 event_dev->dev_port, ndev_pnetid)) {
863 /* remove from PNETIDs list */
864 smc_pnet_remove_pnetid(net, ndev_pnetid);
865 }
866 return NOTIFY_OK;
867 default:
868 return NOTIFY_DONE;
869 }
870}
871
872static struct notifier_block smc_netdev_notifier = {
873 .notifier_call = smc_pnet_netdev_event
874};
875
876/* init network namespace */
877int smc_pnet_net_init(struct net *net)
878{
879 struct smc_net *sn = net_generic(net, smc_net_id);
880 struct smc_pnettable *pnettable = &sn->pnettable;
881 struct smc_pnetids_ndev *pnetids_ndev = &sn->pnetids_ndev;
882
883 INIT_LIST_HEAD(&pnettable->pnetlist);
884 mutex_init(&pnettable->lock);
885 INIT_LIST_HEAD(&pnetids_ndev->list);
886 rwlock_init(&pnetids_ndev->lock);
887
888 smc_pnet_create_pnetids_list(net);
889
890 return 0;
891}
892
893int __init smc_pnet_init(void)
894{
895 int rc;
896
897 rc = genl_register_family(&smc_pnet_nl_family);
898 if (rc)
899 return rc;
900 rc = register_netdevice_notifier(&smc_netdev_notifier);
901 if (rc)
902 genl_unregister_family(&smc_pnet_nl_family);
903
904 return rc;
905}
906
907/* exit network namespace */
908void smc_pnet_net_exit(struct net *net)
909{
910 /* flush pnet table */
911 smc_pnet_remove_by_pnetid(net, NULL);
912 smc_pnet_destroy_pnetids_list(net);
913}
914
915void smc_pnet_exit(void)
916{
917 unregister_netdevice_notifier(&smc_netdev_notifier);
918 genl_unregister_family(&smc_pnet_nl_family);
919}
920
921static struct net_device *__pnet_find_base_ndev(struct net_device *ndev)
922{
923 int i, nest_lvl;
924
925 ASSERT_RTNL();
926 nest_lvl = ndev->lower_level;
927 for (i = 0; i < nest_lvl; i++) {
928 struct list_head *lower = &ndev->adj_list.lower;
929
930 if (list_empty(lower))
931 break;
932 lower = lower->next;
933 ndev = netdev_lower_get_next(ndev, &lower);
934 }
935 return ndev;
936}
937
938/* Determine one base device for stacked net devices.
939 * If the lower device level contains more than one devices
940 * (for instance with bonding slaves), just the first device
941 * is used to reach a base device.
942 */
943static struct net_device *pnet_find_base_ndev(struct net_device *ndev)
944{
945 rtnl_lock();
946 ndev = __pnet_find_base_ndev(ndev);
947 rtnl_unlock();
948 return ndev;
949}
950
951static int smc_pnet_find_ndev_pnetid_by_table(struct net_device *ndev,
952 u8 *pnetid)
953{
954 struct smc_pnettable *pnettable;
955 struct net *net = dev_net(ndev);
956 struct smc_pnetentry *pnetelem;
957 struct smc_net *sn;
958 int rc = -ENOENT;
959
960 /* get pnettable for namespace */
961 sn = net_generic(net, smc_net_id);
962 pnettable = &sn->pnettable;
963
964 mutex_lock(&pnettable->lock);
965 list_for_each_entry(pnetelem, &pnettable->pnetlist, list) {
966 if (pnetelem->type == SMC_PNET_ETH && ndev == pnetelem->ndev) {
967 /* get pnetid of netdev device */
968 memcpy(pnetid, pnetelem->pnet_name, SMC_MAX_PNETID_LEN);
969 rc = 0;
970 break;
971 }
972 }
973 mutex_unlock(&pnettable->lock);
974 return rc;
975}
976
977static int smc_pnet_determine_gid(struct smc_ib_device *ibdev, int i,
978 struct smc_init_info *ini)
979{
980 if (!ini->check_smcrv2 &&
981 !smc_ib_determine_gid(ibdev, i, ini->vlan_id, ini->ib_gid, NULL,
982 NULL)) {
983 ini->ib_dev = ibdev;
984 ini->ib_port = i;
985 return 0;
986 }
987 if (ini->check_smcrv2 &&
988 !smc_ib_determine_gid(ibdev, i, ini->vlan_id, ini->smcrv2.ib_gid_v2,
989 NULL, &ini->smcrv2)) {
990 ini->smcrv2.ib_dev_v2 = ibdev;
991 ini->smcrv2.ib_port_v2 = i;
992 return 0;
993 }
994 return -ENODEV;
995}
996
997/* find a roce device for the given pnetid */
998static void _smc_pnet_find_roce_by_pnetid(u8 *pnet_id,
999 struct smc_init_info *ini,
1000 struct smc_ib_device *known_dev,
1001 struct net *net)
1002{
1003 struct smc_ib_device *ibdev;
1004 int i;
1005
1006 mutex_lock(&smc_ib_devices.mutex);
1007 list_for_each_entry(ibdev, &smc_ib_devices.list, list) {
1008 if (ibdev == known_dev ||
1009 !rdma_dev_access_netns(ibdev->ibdev, net))
1010 continue;
1011 for (i = 1; i <= SMC_MAX_PORTS; i++) {
1012 if (!rdma_is_port_valid(ibdev->ibdev, i))
1013 continue;
1014 if (smc_pnet_match(ibdev->pnetid[i - 1], pnet_id) &&
1015 smc_ib_port_active(ibdev, i) &&
1016 !test_bit(i - 1, ibdev->ports_going_away)) {
1017 if (!smc_pnet_determine_gid(ibdev, i, ini))
1018 goto out;
1019 }
1020 }
1021 }
1022out:
1023 mutex_unlock(&smc_ib_devices.mutex);
1024}
1025
1026/* find alternate roce device with same pnet_id, vlan_id and net namespace */
1027void smc_pnet_find_alt_roce(struct smc_link_group *lgr,
1028 struct smc_init_info *ini,
1029 struct smc_ib_device *known_dev)
1030{
1031 struct net *net = lgr->net;
1032
1033 _smc_pnet_find_roce_by_pnetid(lgr->pnet_id, ini, known_dev, net);
1034}
1035
1036/* if handshake network device belongs to a roce device, return its
1037 * IB device and port
1038 */
1039static void smc_pnet_find_rdma_dev(struct net_device *netdev,
1040 struct smc_init_info *ini)
1041{
1042 struct net *net = dev_net(netdev);
1043 struct smc_ib_device *ibdev;
1044
1045 mutex_lock(&smc_ib_devices.mutex);
1046 list_for_each_entry(ibdev, &smc_ib_devices.list, list) {
1047 struct net_device *ndev;
1048 int i;
1049
1050 /* check rdma net namespace */
1051 if (!rdma_dev_access_netns(ibdev->ibdev, net))
1052 continue;
1053
1054 for (i = 1; i <= SMC_MAX_PORTS; i++) {
1055 if (!rdma_is_port_valid(ibdev->ibdev, i))
1056 continue;
1057 ndev = ib_device_get_netdev(ibdev->ibdev, i);
1058 if (!ndev)
1059 continue;
1060 dev_put(ndev);
1061 if (netdev == ndev &&
1062 smc_ib_port_active(ibdev, i) &&
1063 !test_bit(i - 1, ibdev->ports_going_away)) {
1064 if (!smc_pnet_determine_gid(ibdev, i, ini))
1065 break;
1066 }
1067 }
1068 }
1069 mutex_unlock(&smc_ib_devices.mutex);
1070}
1071
1072/* Determine the corresponding IB device port based on the hardware PNETID.
1073 * Searching stops at the first matching active IB device port with vlan_id
1074 * configured.
1075 * If nothing found, check pnetid table.
1076 * If nothing found, try to use handshake device
1077 */
1078static void smc_pnet_find_roce_by_pnetid(struct net_device *ndev,
1079 struct smc_init_info *ini)
1080{
1081 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
1082 struct net *net;
1083
1084 ndev = pnet_find_base_ndev(ndev);
1085 net = dev_net(ndev);
1086 if (smc_pnetid_by_dev_port(ndev->dev.parent, ndev->dev_port,
1087 ndev_pnetid) &&
1088 smc_pnet_find_ndev_pnetid_by_table(ndev, ndev_pnetid)) {
1089 smc_pnet_find_rdma_dev(ndev, ini);
1090 return; /* pnetid could not be determined */
1091 }
1092 _smc_pnet_find_roce_by_pnetid(ndev_pnetid, ini, NULL, net);
1093}
1094
1095static void smc_pnet_find_ism_by_pnetid(struct net_device *ndev,
1096 struct smc_init_info *ini)
1097{
1098 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
1099 struct smcd_dev *ismdev;
1100
1101 ndev = pnet_find_base_ndev(ndev);
1102 if (smc_pnetid_by_dev_port(ndev->dev.parent, ndev->dev_port,
1103 ndev_pnetid) &&
1104 smc_pnet_find_ndev_pnetid_by_table(ndev, ndev_pnetid))
1105 return; /* pnetid could not be determined */
1106
1107 mutex_lock(&smcd_dev_list.mutex);
1108 list_for_each_entry(ismdev, &smcd_dev_list.list, list) {
1109 if (smc_pnet_match(ismdev->pnetid, ndev_pnetid) &&
1110 !ismdev->going_away &&
1111 (!ini->ism_peer_gid[0].gid ||
1112 !smc_ism_cantalk(&ini->ism_peer_gid[0], ini->vlan_id,
1113 ismdev))) {
1114 ini->ism_dev[0] = ismdev;
1115 break;
1116 }
1117 }
1118 mutex_unlock(&smcd_dev_list.mutex);
1119}
1120
1121/* PNET table analysis for a given sock:
1122 * determine ib_device and port belonging to used internal TCP socket
1123 * ethernet interface.
1124 */
1125void smc_pnet_find_roce_resource(struct sock *sk, struct smc_init_info *ini)
1126{
1127 struct dst_entry *dst = sk_dst_get(sk);
1128
1129 if (!dst)
1130 goto out;
1131 if (!dst->dev)
1132 goto out_rel;
1133
1134 smc_pnet_find_roce_by_pnetid(dst->dev, ini);
1135
1136out_rel:
1137 dst_release(dst);
1138out:
1139 return;
1140}
1141
1142void smc_pnet_find_ism_resource(struct sock *sk, struct smc_init_info *ini)
1143{
1144 struct dst_entry *dst = sk_dst_get(sk);
1145
1146 ini->ism_dev[0] = NULL;
1147 if (!dst)
1148 goto out;
1149 if (!dst->dev)
1150 goto out_rel;
1151
1152 smc_pnet_find_ism_by_pnetid(dst->dev, ini);
1153
1154out_rel:
1155 dst_release(dst);
1156out:
1157 return;
1158}
1159
1160/* Lookup and apply a pnet table entry to the given ib device.
1161 */
1162int smc_pnetid_by_table_ib(struct smc_ib_device *smcibdev, u8 ib_port)
1163{
1164 char *ib_name = smcibdev->ibdev->name;
1165 struct smc_pnettable *pnettable;
1166 struct smc_pnetentry *tmp_pe;
1167 struct smc_net *sn;
1168 int rc = -ENOENT;
1169
1170 /* get pnettable for init namespace */
1171 sn = net_generic(&init_net, smc_net_id);
1172 pnettable = &sn->pnettable;
1173
1174 mutex_lock(&pnettable->lock);
1175 list_for_each_entry(tmp_pe, &pnettable->pnetlist, list) {
1176 if (tmp_pe->type == SMC_PNET_IB &&
1177 !strncmp(tmp_pe->ib_name, ib_name, IB_DEVICE_NAME_MAX) &&
1178 tmp_pe->ib_port == ib_port) {
1179 smc_pnet_apply_ib(smcibdev, ib_port, tmp_pe->pnet_name);
1180 rc = 0;
1181 break;
1182 }
1183 }
1184 mutex_unlock(&pnettable->lock);
1185
1186 return rc;
1187}
1188
1189/* Lookup and apply a pnet table entry to the given smcd device.
1190 */
1191int smc_pnetid_by_table_smcd(struct smcd_dev *smcddev)
1192{
1193 const char *ib_name = dev_name(smcddev->ops->get_dev(smcddev));
1194 struct smc_pnettable *pnettable;
1195 struct smc_pnetentry *tmp_pe;
1196 struct smc_net *sn;
1197 int rc = -ENOENT;
1198
1199 /* get pnettable for init namespace */
1200 sn = net_generic(&init_net, smc_net_id);
1201 pnettable = &sn->pnettable;
1202
1203 mutex_lock(&pnettable->lock);
1204 list_for_each_entry(tmp_pe, &pnettable->pnetlist, list) {
1205 if (tmp_pe->type == SMC_PNET_IB &&
1206 !strncmp(tmp_pe->ib_name, ib_name, IB_DEVICE_NAME_MAX)) {
1207 smc_pnet_apply_smcd(smcddev, tmp_pe->pnet_name);
1208 rc = 0;
1209 break;
1210 }
1211 }
1212 mutex_unlock(&pnettable->lock);
1213
1214 return rc;
1215}
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Shared Memory Communications over RDMA (SMC-R) and RoCE
4 *
5 * Generic netlink support functions to configure an SMC-R PNET table
6 *
7 * Copyright IBM Corp. 2016
8 *
9 * Author(s): Thomas Richter <tmricht@linux.vnet.ibm.com>
10 */
11
12#include <linux/module.h>
13#include <linux/list.h>
14#include <linux/ctype.h>
15#include <linux/mutex.h>
16#include <net/netlink.h>
17#include <net/genetlink.h>
18
19#include <uapi/linux/if.h>
20#include <uapi/linux/smc.h>
21
22#include <rdma/ib_verbs.h>
23
24#include <net/netns/generic.h>
25#include "smc_netns.h"
26
27#include "smc_pnet.h"
28#include "smc_ib.h"
29#include "smc_ism.h"
30#include "smc_core.h"
31
32static struct net_device *__pnet_find_base_ndev(struct net_device *ndev);
33static struct net_device *pnet_find_base_ndev(struct net_device *ndev);
34
35static const struct nla_policy smc_pnet_policy[SMC_PNETID_MAX + 1] = {
36 [SMC_PNETID_NAME] = {
37 .type = NLA_NUL_STRING,
38 .len = SMC_MAX_PNETID_LEN
39 },
40 [SMC_PNETID_ETHNAME] = {
41 .type = NLA_NUL_STRING,
42 .len = IFNAMSIZ - 1
43 },
44 [SMC_PNETID_IBNAME] = {
45 .type = NLA_NUL_STRING,
46 .len = IB_DEVICE_NAME_MAX - 1
47 },
48 [SMC_PNETID_IBPORT] = { .type = NLA_U8 }
49};
50
51static struct genl_family smc_pnet_nl_family;
52
53enum smc_pnet_nametype {
54 SMC_PNET_ETH = 1,
55 SMC_PNET_IB = 2,
56};
57
58/* pnet entry stored in pnet table */
59struct smc_pnetentry {
60 struct list_head list;
61 char pnet_name[SMC_MAX_PNETID_LEN + 1];
62 enum smc_pnet_nametype type;
63 union {
64 struct {
65 char eth_name[IFNAMSIZ + 1];
66 struct net_device *ndev;
67 netdevice_tracker dev_tracker;
68 };
69 struct {
70 char ib_name[IB_DEVICE_NAME_MAX + 1];
71 u8 ib_port;
72 };
73 };
74};
75
76/* Check if the pnetid is set */
77bool smc_pnet_is_pnetid_set(u8 *pnetid)
78{
79 if (pnetid[0] == 0 || pnetid[0] == _S)
80 return false;
81 return true;
82}
83
84/* Check if two given pnetids match */
85static bool smc_pnet_match(u8 *pnetid1, u8 *pnetid2)
86{
87 int i;
88
89 for (i = 0; i < SMC_MAX_PNETID_LEN; i++) {
90 if ((pnetid1[i] == 0 || pnetid1[i] == _S) &&
91 (pnetid2[i] == 0 || pnetid2[i] == _S))
92 break;
93 if (pnetid1[i] != pnetid2[i])
94 return false;
95 }
96 return true;
97}
98
99/* Remove a pnetid from the pnet table.
100 */
101static int smc_pnet_remove_by_pnetid(struct net *net, char *pnet_name)
102{
103 struct smc_pnetentry *pnetelem, *tmp_pe;
104 struct smc_pnettable *pnettable;
105 struct smc_ib_device *ibdev;
106 struct smcd_dev *smcd_dev;
107 struct smc_net *sn;
108 int rc = -ENOENT;
109 int ibport;
110
111 /* get pnettable for namespace */
112 sn = net_generic(net, smc_net_id);
113 pnettable = &sn->pnettable;
114
115 /* remove table entry */
116 mutex_lock(&pnettable->lock);
117 list_for_each_entry_safe(pnetelem, tmp_pe, &pnettable->pnetlist,
118 list) {
119 if (!pnet_name ||
120 smc_pnet_match(pnetelem->pnet_name, pnet_name)) {
121 list_del(&pnetelem->list);
122 if (pnetelem->type == SMC_PNET_ETH && pnetelem->ndev) {
123 netdev_put(pnetelem->ndev,
124 &pnetelem->dev_tracker);
125 pr_warn_ratelimited("smc: net device %s "
126 "erased user defined "
127 "pnetid %.16s\n",
128 pnetelem->eth_name,
129 pnetelem->pnet_name);
130 }
131 kfree(pnetelem);
132 rc = 0;
133 }
134 }
135 mutex_unlock(&pnettable->lock);
136
137 /* if this is not the initial namespace, stop here */
138 if (net != &init_net)
139 return rc;
140
141 /* remove ib devices */
142 mutex_lock(&smc_ib_devices.mutex);
143 list_for_each_entry(ibdev, &smc_ib_devices.list, list) {
144 for (ibport = 0; ibport < SMC_MAX_PORTS; ibport++) {
145 if (ibdev->pnetid_by_user[ibport] &&
146 (!pnet_name ||
147 smc_pnet_match(pnet_name,
148 ibdev->pnetid[ibport]))) {
149 pr_warn_ratelimited("smc: ib device %s ibport "
150 "%d erased user defined "
151 "pnetid %.16s\n",
152 ibdev->ibdev->name,
153 ibport + 1,
154 ibdev->pnetid[ibport]);
155 memset(ibdev->pnetid[ibport], 0,
156 SMC_MAX_PNETID_LEN);
157 ibdev->pnetid_by_user[ibport] = false;
158 rc = 0;
159 }
160 }
161 }
162 mutex_unlock(&smc_ib_devices.mutex);
163 /* remove smcd devices */
164 mutex_lock(&smcd_dev_list.mutex);
165 list_for_each_entry(smcd_dev, &smcd_dev_list.list, list) {
166 if (smcd_dev->pnetid_by_user &&
167 (!pnet_name ||
168 smc_pnet_match(pnet_name, smcd_dev->pnetid))) {
169 pr_warn_ratelimited("smc: smcd device %s "
170 "erased user defined pnetid "
171 "%.16s\n", dev_name(&smcd_dev->dev),
172 smcd_dev->pnetid);
173 memset(smcd_dev->pnetid, 0, SMC_MAX_PNETID_LEN);
174 smcd_dev->pnetid_by_user = false;
175 rc = 0;
176 }
177 }
178 mutex_unlock(&smcd_dev_list.mutex);
179 return rc;
180}
181
182/* Add the reference to a given network device to the pnet table.
183 */
184static int smc_pnet_add_by_ndev(struct net_device *ndev)
185{
186 struct smc_pnetentry *pnetelem, *tmp_pe;
187 struct smc_pnettable *pnettable;
188 struct net *net = dev_net(ndev);
189 struct smc_net *sn;
190 int rc = -ENOENT;
191
192 /* get pnettable for namespace */
193 sn = net_generic(net, smc_net_id);
194 pnettable = &sn->pnettable;
195
196 mutex_lock(&pnettable->lock);
197 list_for_each_entry_safe(pnetelem, tmp_pe, &pnettable->pnetlist, list) {
198 if (pnetelem->type == SMC_PNET_ETH && !pnetelem->ndev &&
199 !strncmp(pnetelem->eth_name, ndev->name, IFNAMSIZ)) {
200 netdev_hold(ndev, &pnetelem->dev_tracker, GFP_ATOMIC);
201 pnetelem->ndev = ndev;
202 rc = 0;
203 pr_warn_ratelimited("smc: adding net device %s with "
204 "user defined pnetid %.16s\n",
205 pnetelem->eth_name,
206 pnetelem->pnet_name);
207 break;
208 }
209 }
210 mutex_unlock(&pnettable->lock);
211 return rc;
212}
213
214/* Remove the reference to a given network device from the pnet table.
215 */
216static int smc_pnet_remove_by_ndev(struct net_device *ndev)
217{
218 struct smc_pnetentry *pnetelem, *tmp_pe;
219 struct smc_pnettable *pnettable;
220 struct net *net = dev_net(ndev);
221 struct smc_net *sn;
222 int rc = -ENOENT;
223
224 /* get pnettable for namespace */
225 sn = net_generic(net, smc_net_id);
226 pnettable = &sn->pnettable;
227
228 mutex_lock(&pnettable->lock);
229 list_for_each_entry_safe(pnetelem, tmp_pe, &pnettable->pnetlist, list) {
230 if (pnetelem->type == SMC_PNET_ETH && pnetelem->ndev == ndev) {
231 netdev_put(pnetelem->ndev, &pnetelem->dev_tracker);
232 pnetelem->ndev = NULL;
233 rc = 0;
234 pr_warn_ratelimited("smc: removing net device %s with "
235 "user defined pnetid %.16s\n",
236 pnetelem->eth_name,
237 pnetelem->pnet_name);
238 break;
239 }
240 }
241 mutex_unlock(&pnettable->lock);
242 return rc;
243}
244
245/* Apply pnetid to ib device when no pnetid is set.
246 */
247static bool smc_pnet_apply_ib(struct smc_ib_device *ib_dev, u8 ib_port,
248 char *pnet_name)
249{
250 bool applied = false;
251
252 mutex_lock(&smc_ib_devices.mutex);
253 if (!smc_pnet_is_pnetid_set(ib_dev->pnetid[ib_port - 1])) {
254 memcpy(ib_dev->pnetid[ib_port - 1], pnet_name,
255 SMC_MAX_PNETID_LEN);
256 ib_dev->pnetid_by_user[ib_port - 1] = true;
257 applied = true;
258 }
259 mutex_unlock(&smc_ib_devices.mutex);
260 return applied;
261}
262
263/* Apply pnetid to smcd device when no pnetid is set.
264 */
265static bool smc_pnet_apply_smcd(struct smcd_dev *smcd_dev, char *pnet_name)
266{
267 bool applied = false;
268
269 mutex_lock(&smcd_dev_list.mutex);
270 if (!smc_pnet_is_pnetid_set(smcd_dev->pnetid)) {
271 memcpy(smcd_dev->pnetid, pnet_name, SMC_MAX_PNETID_LEN);
272 smcd_dev->pnetid_by_user = true;
273 applied = true;
274 }
275 mutex_unlock(&smcd_dev_list.mutex);
276 return applied;
277}
278
279/* The limit for pnetid is 16 characters.
280 * Valid characters should be (single-byte character set) a-z, A-Z, 0-9.
281 * Lower case letters are converted to upper case.
282 * Interior blanks should not be used.
283 */
284static bool smc_pnetid_valid(const char *pnet_name, char *pnetid)
285{
286 char *bf = skip_spaces(pnet_name);
287 size_t len = strlen(bf);
288 char *end = bf + len;
289
290 if (!len)
291 return false;
292 while (--end >= bf && isspace(*end))
293 ;
294 if (end - bf >= SMC_MAX_PNETID_LEN)
295 return false;
296 while (bf <= end) {
297 if (!isalnum(*bf))
298 return false;
299 *pnetid++ = islower(*bf) ? toupper(*bf) : *bf;
300 bf++;
301 }
302 *pnetid = '\0';
303 return true;
304}
305
306/* Find an infiniband device by a given name. The device might not exist. */
307static struct smc_ib_device *smc_pnet_find_ib(char *ib_name)
308{
309 struct smc_ib_device *ibdev;
310
311 mutex_lock(&smc_ib_devices.mutex);
312 list_for_each_entry(ibdev, &smc_ib_devices.list, list) {
313 if (!strncmp(ibdev->ibdev->name, ib_name,
314 sizeof(ibdev->ibdev->name)) ||
315 (ibdev->ibdev->dev.parent &&
316 !strncmp(dev_name(ibdev->ibdev->dev.parent), ib_name,
317 IB_DEVICE_NAME_MAX - 1))) {
318 goto out;
319 }
320 }
321 ibdev = NULL;
322out:
323 mutex_unlock(&smc_ib_devices.mutex);
324 return ibdev;
325}
326
327/* Find an smcd device by a given name. The device might not exist. */
328static struct smcd_dev *smc_pnet_find_smcd(char *smcd_name)
329{
330 struct smcd_dev *smcd_dev;
331
332 mutex_lock(&smcd_dev_list.mutex);
333 list_for_each_entry(smcd_dev, &smcd_dev_list.list, list) {
334 if (!strncmp(dev_name(&smcd_dev->dev), smcd_name,
335 IB_DEVICE_NAME_MAX - 1))
336 goto out;
337 }
338 smcd_dev = NULL;
339out:
340 mutex_unlock(&smcd_dev_list.mutex);
341 return smcd_dev;
342}
343
344static int smc_pnet_add_eth(struct smc_pnettable *pnettable, struct net *net,
345 char *eth_name, char *pnet_name)
346{
347 struct smc_pnetentry *tmp_pe, *new_pe;
348 struct net_device *ndev, *base_ndev;
349 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
350 bool new_netdev;
351 int rc;
352
353 /* check if (base) netdev already has a pnetid. If there is one, we do
354 * not want to add a pnet table entry
355 */
356 rc = -EEXIST;
357 ndev = dev_get_by_name(net, eth_name); /* dev_hold() */
358 if (ndev) {
359 base_ndev = pnet_find_base_ndev(ndev);
360 if (!smc_pnetid_by_dev_port(base_ndev->dev.parent,
361 base_ndev->dev_port, ndev_pnetid))
362 goto out_put;
363 }
364
365 /* add a new netdev entry to the pnet table if there isn't one */
366 rc = -ENOMEM;
367 new_pe = kzalloc(sizeof(*new_pe), GFP_KERNEL);
368 if (!new_pe)
369 goto out_put;
370 new_pe->type = SMC_PNET_ETH;
371 memcpy(new_pe->pnet_name, pnet_name, SMC_MAX_PNETID_LEN);
372 strncpy(new_pe->eth_name, eth_name, IFNAMSIZ);
373 rc = -EEXIST;
374 new_netdev = true;
375 mutex_lock(&pnettable->lock);
376 list_for_each_entry(tmp_pe, &pnettable->pnetlist, list) {
377 if (tmp_pe->type == SMC_PNET_ETH &&
378 !strncmp(tmp_pe->eth_name, eth_name, IFNAMSIZ)) {
379 new_netdev = false;
380 break;
381 }
382 }
383 if (new_netdev) {
384 if (ndev) {
385 new_pe->ndev = ndev;
386 netdev_tracker_alloc(ndev, &new_pe->dev_tracker,
387 GFP_ATOMIC);
388 }
389 list_add_tail(&new_pe->list, &pnettable->pnetlist);
390 mutex_unlock(&pnettable->lock);
391 } else {
392 mutex_unlock(&pnettable->lock);
393 kfree(new_pe);
394 goto out_put;
395 }
396 if (ndev)
397 pr_warn_ratelimited("smc: net device %s "
398 "applied user defined pnetid %.16s\n",
399 new_pe->eth_name, new_pe->pnet_name);
400 return 0;
401
402out_put:
403 dev_put(ndev);
404 return rc;
405}
406
407static int smc_pnet_add_ib(struct smc_pnettable *pnettable, char *ib_name,
408 u8 ib_port, char *pnet_name)
409{
410 struct smc_pnetentry *tmp_pe, *new_pe;
411 struct smc_ib_device *ib_dev;
412 bool smcddev_applied = true;
413 bool ibdev_applied = true;
414 struct smcd_dev *smcd_dev;
415 bool new_ibdev;
416
417 /* try to apply the pnetid to active devices */
418 ib_dev = smc_pnet_find_ib(ib_name);
419 if (ib_dev) {
420 ibdev_applied = smc_pnet_apply_ib(ib_dev, ib_port, pnet_name);
421 if (ibdev_applied)
422 pr_warn_ratelimited("smc: ib device %s ibport %d "
423 "applied user defined pnetid "
424 "%.16s\n", ib_dev->ibdev->name,
425 ib_port,
426 ib_dev->pnetid[ib_port - 1]);
427 }
428 smcd_dev = smc_pnet_find_smcd(ib_name);
429 if (smcd_dev) {
430 smcddev_applied = smc_pnet_apply_smcd(smcd_dev, pnet_name);
431 if (smcddev_applied)
432 pr_warn_ratelimited("smc: smcd device %s "
433 "applied user defined pnetid "
434 "%.16s\n", dev_name(&smcd_dev->dev),
435 smcd_dev->pnetid);
436 }
437 /* Apply fails when a device has a hardware-defined pnetid set, do not
438 * add a pnet table entry in that case.
439 */
440 if (!ibdev_applied || !smcddev_applied)
441 return -EEXIST;
442
443 /* add a new ib entry to the pnet table if there isn't one */
444 new_pe = kzalloc(sizeof(*new_pe), GFP_KERNEL);
445 if (!new_pe)
446 return -ENOMEM;
447 new_pe->type = SMC_PNET_IB;
448 memcpy(new_pe->pnet_name, pnet_name, SMC_MAX_PNETID_LEN);
449 strncpy(new_pe->ib_name, ib_name, IB_DEVICE_NAME_MAX);
450 new_pe->ib_port = ib_port;
451
452 new_ibdev = true;
453 mutex_lock(&pnettable->lock);
454 list_for_each_entry(tmp_pe, &pnettable->pnetlist, list) {
455 if (tmp_pe->type == SMC_PNET_IB &&
456 !strncmp(tmp_pe->ib_name, ib_name, IB_DEVICE_NAME_MAX)) {
457 new_ibdev = false;
458 break;
459 }
460 }
461 if (new_ibdev) {
462 list_add_tail(&new_pe->list, &pnettable->pnetlist);
463 mutex_unlock(&pnettable->lock);
464 } else {
465 mutex_unlock(&pnettable->lock);
466 kfree(new_pe);
467 }
468 return (new_ibdev) ? 0 : -EEXIST;
469}
470
471/* Append a pnetid to the end of the pnet table if not already on this list.
472 */
473static int smc_pnet_enter(struct net *net, struct nlattr *tb[])
474{
475 char pnet_name[SMC_MAX_PNETID_LEN + 1];
476 struct smc_pnettable *pnettable;
477 bool new_netdev = false;
478 bool new_ibdev = false;
479 struct smc_net *sn;
480 u8 ibport = 1;
481 char *string;
482 int rc;
483
484 /* get pnettable for namespace */
485 sn = net_generic(net, smc_net_id);
486 pnettable = &sn->pnettable;
487
488 rc = -EINVAL;
489 if (!tb[SMC_PNETID_NAME])
490 goto error;
491 string = (char *)nla_data(tb[SMC_PNETID_NAME]);
492 if (!smc_pnetid_valid(string, pnet_name))
493 goto error;
494
495 if (tb[SMC_PNETID_ETHNAME]) {
496 string = (char *)nla_data(tb[SMC_PNETID_ETHNAME]);
497 rc = smc_pnet_add_eth(pnettable, net, string, pnet_name);
498 if (!rc)
499 new_netdev = true;
500 else if (rc != -EEXIST)
501 goto error;
502 }
503
504 /* if this is not the initial namespace, stop here */
505 if (net != &init_net)
506 return new_netdev ? 0 : -EEXIST;
507
508 rc = -EINVAL;
509 if (tb[SMC_PNETID_IBNAME]) {
510 string = (char *)nla_data(tb[SMC_PNETID_IBNAME]);
511 string = strim(string);
512 if (tb[SMC_PNETID_IBPORT]) {
513 ibport = nla_get_u8(tb[SMC_PNETID_IBPORT]);
514 if (ibport < 1 || ibport > SMC_MAX_PORTS)
515 goto error;
516 }
517 rc = smc_pnet_add_ib(pnettable, string, ibport, pnet_name);
518 if (!rc)
519 new_ibdev = true;
520 else if (rc != -EEXIST)
521 goto error;
522 }
523 return (new_netdev || new_ibdev) ? 0 : -EEXIST;
524
525error:
526 return rc;
527}
528
529/* Convert an smc_pnetentry to a netlink attribute sequence */
530static int smc_pnet_set_nla(struct sk_buff *msg,
531 struct smc_pnetentry *pnetelem)
532{
533 if (nla_put_string(msg, SMC_PNETID_NAME, pnetelem->pnet_name))
534 return -1;
535 if (pnetelem->type == SMC_PNET_ETH) {
536 if (nla_put_string(msg, SMC_PNETID_ETHNAME,
537 pnetelem->eth_name))
538 return -1;
539 } else {
540 if (nla_put_string(msg, SMC_PNETID_ETHNAME, "n/a"))
541 return -1;
542 }
543 if (pnetelem->type == SMC_PNET_IB) {
544 if (nla_put_string(msg, SMC_PNETID_IBNAME, pnetelem->ib_name) ||
545 nla_put_u8(msg, SMC_PNETID_IBPORT, pnetelem->ib_port))
546 return -1;
547 } else {
548 if (nla_put_string(msg, SMC_PNETID_IBNAME, "n/a") ||
549 nla_put_u8(msg, SMC_PNETID_IBPORT, 0xff))
550 return -1;
551 }
552
553 return 0;
554}
555
556static int smc_pnet_add(struct sk_buff *skb, struct genl_info *info)
557{
558 struct net *net = genl_info_net(info);
559
560 return smc_pnet_enter(net, info->attrs);
561}
562
563static int smc_pnet_del(struct sk_buff *skb, struct genl_info *info)
564{
565 struct net *net = genl_info_net(info);
566
567 if (!info->attrs[SMC_PNETID_NAME])
568 return -EINVAL;
569 return smc_pnet_remove_by_pnetid(net,
570 (char *)nla_data(info->attrs[SMC_PNETID_NAME]));
571}
572
573static int smc_pnet_dump_start(struct netlink_callback *cb)
574{
575 cb->args[0] = 0;
576 return 0;
577}
578
579static int smc_pnet_dumpinfo(struct sk_buff *skb,
580 u32 portid, u32 seq, u32 flags,
581 struct smc_pnetentry *pnetelem)
582{
583 void *hdr;
584
585 hdr = genlmsg_put(skb, portid, seq, &smc_pnet_nl_family,
586 flags, SMC_PNETID_GET);
587 if (!hdr)
588 return -ENOMEM;
589 if (smc_pnet_set_nla(skb, pnetelem) < 0) {
590 genlmsg_cancel(skb, hdr);
591 return -EMSGSIZE;
592 }
593 genlmsg_end(skb, hdr);
594 return 0;
595}
596
597static int _smc_pnet_dump(struct net *net, struct sk_buff *skb, u32 portid,
598 u32 seq, u8 *pnetid, int start_idx)
599{
600 struct smc_pnettable *pnettable;
601 struct smc_pnetentry *pnetelem;
602 struct smc_net *sn;
603 int idx = 0;
604
605 /* get pnettable for namespace */
606 sn = net_generic(net, smc_net_id);
607 pnettable = &sn->pnettable;
608
609 /* dump pnettable entries */
610 mutex_lock(&pnettable->lock);
611 list_for_each_entry(pnetelem, &pnettable->pnetlist, list) {
612 if (pnetid && !smc_pnet_match(pnetelem->pnet_name, pnetid))
613 continue;
614 if (idx++ < start_idx)
615 continue;
616 /* if this is not the initial namespace, dump only netdev */
617 if (net != &init_net && pnetelem->type != SMC_PNET_ETH)
618 continue;
619 if (smc_pnet_dumpinfo(skb, portid, seq, NLM_F_MULTI,
620 pnetelem)) {
621 --idx;
622 break;
623 }
624 }
625 mutex_unlock(&pnettable->lock);
626 return idx;
627}
628
629static int smc_pnet_dump(struct sk_buff *skb, struct netlink_callback *cb)
630{
631 struct net *net = sock_net(skb->sk);
632 int idx;
633
634 idx = _smc_pnet_dump(net, skb, NETLINK_CB(cb->skb).portid,
635 cb->nlh->nlmsg_seq, NULL, cb->args[0]);
636
637 cb->args[0] = idx;
638 return skb->len;
639}
640
641/* Retrieve one PNETID entry */
642static int smc_pnet_get(struct sk_buff *skb, struct genl_info *info)
643{
644 struct net *net = genl_info_net(info);
645 struct sk_buff *msg;
646 void *hdr;
647
648 if (!info->attrs[SMC_PNETID_NAME])
649 return -EINVAL;
650
651 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
652 if (!msg)
653 return -ENOMEM;
654
655 _smc_pnet_dump(net, msg, info->snd_portid, info->snd_seq,
656 nla_data(info->attrs[SMC_PNETID_NAME]), 0);
657
658 /* finish multi part message and send it */
659 hdr = nlmsg_put(msg, info->snd_portid, info->snd_seq, NLMSG_DONE, 0,
660 NLM_F_MULTI);
661 if (!hdr) {
662 nlmsg_free(msg);
663 return -EMSGSIZE;
664 }
665 return genlmsg_reply(msg, info);
666}
667
668/* Remove and delete all pnetids from pnet table.
669 */
670static int smc_pnet_flush(struct sk_buff *skb, struct genl_info *info)
671{
672 struct net *net = genl_info_net(info);
673
674 smc_pnet_remove_by_pnetid(net, NULL);
675 return 0;
676}
677
678/* SMC_PNETID generic netlink operation definition */
679static const struct genl_ops smc_pnet_ops[] = {
680 {
681 .cmd = SMC_PNETID_GET,
682 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
683 /* can be retrieved by unprivileged users */
684 .doit = smc_pnet_get,
685 .dumpit = smc_pnet_dump,
686 .start = smc_pnet_dump_start
687 },
688 {
689 .cmd = SMC_PNETID_ADD,
690 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
691 .flags = GENL_ADMIN_PERM,
692 .doit = smc_pnet_add
693 },
694 {
695 .cmd = SMC_PNETID_DEL,
696 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
697 .flags = GENL_ADMIN_PERM,
698 .doit = smc_pnet_del
699 },
700 {
701 .cmd = SMC_PNETID_FLUSH,
702 .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
703 .flags = GENL_ADMIN_PERM,
704 .doit = smc_pnet_flush
705 }
706};
707
708/* SMC_PNETID family definition */
709static struct genl_family smc_pnet_nl_family __ro_after_init = {
710 .hdrsize = 0,
711 .name = SMCR_GENL_FAMILY_NAME,
712 .version = SMCR_GENL_FAMILY_VERSION,
713 .maxattr = SMC_PNETID_MAX,
714 .policy = smc_pnet_policy,
715 .netnsok = true,
716 .module = THIS_MODULE,
717 .ops = smc_pnet_ops,
718 .n_ops = ARRAY_SIZE(smc_pnet_ops),
719 .resv_start_op = SMC_PNETID_FLUSH + 1,
720};
721
722bool smc_pnet_is_ndev_pnetid(struct net *net, u8 *pnetid)
723{
724 struct smc_net *sn = net_generic(net, smc_net_id);
725 struct smc_pnetids_ndev_entry *pe;
726 bool rc = false;
727
728 read_lock(&sn->pnetids_ndev.lock);
729 list_for_each_entry(pe, &sn->pnetids_ndev.list, list) {
730 if (smc_pnet_match(pnetid, pe->pnetid)) {
731 rc = true;
732 goto unlock;
733 }
734 }
735
736unlock:
737 read_unlock(&sn->pnetids_ndev.lock);
738 return rc;
739}
740
741static int smc_pnet_add_pnetid(struct net *net, u8 *pnetid)
742{
743 struct smc_net *sn = net_generic(net, smc_net_id);
744 struct smc_pnetids_ndev_entry *pe, *pi;
745
746 pe = kzalloc(sizeof(*pe), GFP_KERNEL);
747 if (!pe)
748 return -ENOMEM;
749
750 write_lock(&sn->pnetids_ndev.lock);
751 list_for_each_entry(pi, &sn->pnetids_ndev.list, list) {
752 if (smc_pnet_match(pnetid, pe->pnetid)) {
753 refcount_inc(&pi->refcnt);
754 kfree(pe);
755 goto unlock;
756 }
757 }
758 refcount_set(&pe->refcnt, 1);
759 memcpy(pe->pnetid, pnetid, SMC_MAX_PNETID_LEN);
760 list_add_tail(&pe->list, &sn->pnetids_ndev.list);
761
762unlock:
763 write_unlock(&sn->pnetids_ndev.lock);
764 return 0;
765}
766
767static void smc_pnet_remove_pnetid(struct net *net, u8 *pnetid)
768{
769 struct smc_net *sn = net_generic(net, smc_net_id);
770 struct smc_pnetids_ndev_entry *pe, *pe2;
771
772 write_lock(&sn->pnetids_ndev.lock);
773 list_for_each_entry_safe(pe, pe2, &sn->pnetids_ndev.list, list) {
774 if (smc_pnet_match(pnetid, pe->pnetid)) {
775 if (refcount_dec_and_test(&pe->refcnt)) {
776 list_del(&pe->list);
777 kfree(pe);
778 }
779 break;
780 }
781 }
782 write_unlock(&sn->pnetids_ndev.lock);
783}
784
785static void smc_pnet_add_base_pnetid(struct net *net, struct net_device *dev,
786 u8 *ndev_pnetid)
787{
788 struct net_device *base_dev;
789
790 base_dev = __pnet_find_base_ndev(dev);
791 if (base_dev->flags & IFF_UP &&
792 !smc_pnetid_by_dev_port(base_dev->dev.parent, base_dev->dev_port,
793 ndev_pnetid)) {
794 /* add to PNETIDs list */
795 smc_pnet_add_pnetid(net, ndev_pnetid);
796 }
797}
798
799/* create initial list of netdevice pnetids */
800static void smc_pnet_create_pnetids_list(struct net *net)
801{
802 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
803 struct net_device *dev;
804
805 rtnl_lock();
806 for_each_netdev(net, dev)
807 smc_pnet_add_base_pnetid(net, dev, ndev_pnetid);
808 rtnl_unlock();
809}
810
811/* clean up list of netdevice pnetids */
812static void smc_pnet_destroy_pnetids_list(struct net *net)
813{
814 struct smc_net *sn = net_generic(net, smc_net_id);
815 struct smc_pnetids_ndev_entry *pe, *temp_pe;
816
817 write_lock(&sn->pnetids_ndev.lock);
818 list_for_each_entry_safe(pe, temp_pe, &sn->pnetids_ndev.list, list) {
819 list_del(&pe->list);
820 kfree(pe);
821 }
822 write_unlock(&sn->pnetids_ndev.lock);
823}
824
825static int smc_pnet_netdev_event(struct notifier_block *this,
826 unsigned long event, void *ptr)
827{
828 struct net_device *event_dev = netdev_notifier_info_to_dev(ptr);
829 struct net *net = dev_net(event_dev);
830 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
831
832 switch (event) {
833 case NETDEV_REBOOT:
834 case NETDEV_UNREGISTER:
835 smc_pnet_remove_by_ndev(event_dev);
836 smc_ib_ndev_change(event_dev, event);
837 return NOTIFY_OK;
838 case NETDEV_REGISTER:
839 smc_pnet_add_by_ndev(event_dev);
840 smc_ib_ndev_change(event_dev, event);
841 return NOTIFY_OK;
842 case NETDEV_UP:
843 smc_pnet_add_base_pnetid(net, event_dev, ndev_pnetid);
844 return NOTIFY_OK;
845 case NETDEV_DOWN:
846 event_dev = __pnet_find_base_ndev(event_dev);
847 if (!smc_pnetid_by_dev_port(event_dev->dev.parent,
848 event_dev->dev_port, ndev_pnetid)) {
849 /* remove from PNETIDs list */
850 smc_pnet_remove_pnetid(net, ndev_pnetid);
851 }
852 return NOTIFY_OK;
853 default:
854 return NOTIFY_DONE;
855 }
856}
857
858static struct notifier_block smc_netdev_notifier = {
859 .notifier_call = smc_pnet_netdev_event
860};
861
862/* init network namespace */
863int smc_pnet_net_init(struct net *net)
864{
865 struct smc_net *sn = net_generic(net, smc_net_id);
866 struct smc_pnettable *pnettable = &sn->pnettable;
867 struct smc_pnetids_ndev *pnetids_ndev = &sn->pnetids_ndev;
868
869 INIT_LIST_HEAD(&pnettable->pnetlist);
870 mutex_init(&pnettable->lock);
871 INIT_LIST_HEAD(&pnetids_ndev->list);
872 rwlock_init(&pnetids_ndev->lock);
873
874 smc_pnet_create_pnetids_list(net);
875
876 /* disable handshake limitation by default */
877 net->smc.limit_smc_hs = 0;
878
879 return 0;
880}
881
882int __init smc_pnet_init(void)
883{
884 int rc;
885
886 rc = genl_register_family(&smc_pnet_nl_family);
887 if (rc)
888 return rc;
889 rc = register_netdevice_notifier(&smc_netdev_notifier);
890 if (rc)
891 genl_unregister_family(&smc_pnet_nl_family);
892
893 return rc;
894}
895
896/* exit network namespace */
897void smc_pnet_net_exit(struct net *net)
898{
899 /* flush pnet table */
900 smc_pnet_remove_by_pnetid(net, NULL);
901 smc_pnet_destroy_pnetids_list(net);
902}
903
904void smc_pnet_exit(void)
905{
906 unregister_netdevice_notifier(&smc_netdev_notifier);
907 genl_unregister_family(&smc_pnet_nl_family);
908}
909
910static struct net_device *__pnet_find_base_ndev(struct net_device *ndev)
911{
912 int i, nest_lvl;
913
914 ASSERT_RTNL();
915 nest_lvl = ndev->lower_level;
916 for (i = 0; i < nest_lvl; i++) {
917 struct list_head *lower = &ndev->adj_list.lower;
918
919 if (list_empty(lower))
920 break;
921 lower = lower->next;
922 ndev = netdev_lower_get_next(ndev, &lower);
923 }
924 return ndev;
925}
926
927/* Determine one base device for stacked net devices.
928 * If the lower device level contains more than one devices
929 * (for instance with bonding slaves), just the first device
930 * is used to reach a base device.
931 */
932static struct net_device *pnet_find_base_ndev(struct net_device *ndev)
933{
934 rtnl_lock();
935 ndev = __pnet_find_base_ndev(ndev);
936 rtnl_unlock();
937 return ndev;
938}
939
940static int smc_pnet_find_ndev_pnetid_by_table(struct net_device *ndev,
941 u8 *pnetid)
942{
943 struct smc_pnettable *pnettable;
944 struct net *net = dev_net(ndev);
945 struct smc_pnetentry *pnetelem;
946 struct smc_net *sn;
947 int rc = -ENOENT;
948
949 /* get pnettable for namespace */
950 sn = net_generic(net, smc_net_id);
951 pnettable = &sn->pnettable;
952
953 mutex_lock(&pnettable->lock);
954 list_for_each_entry(pnetelem, &pnettable->pnetlist, list) {
955 if (pnetelem->type == SMC_PNET_ETH && ndev == pnetelem->ndev) {
956 /* get pnetid of netdev device */
957 memcpy(pnetid, pnetelem->pnet_name, SMC_MAX_PNETID_LEN);
958 rc = 0;
959 break;
960 }
961 }
962 mutex_unlock(&pnettable->lock);
963 return rc;
964}
965
966static int smc_pnet_determine_gid(struct smc_ib_device *ibdev, int i,
967 struct smc_init_info *ini)
968{
969 if (!ini->check_smcrv2 &&
970 !smc_ib_determine_gid(ibdev, i, ini->vlan_id, ini->ib_gid, NULL,
971 NULL)) {
972 ini->ib_dev = ibdev;
973 ini->ib_port = i;
974 return 0;
975 }
976 if (ini->check_smcrv2 &&
977 !smc_ib_determine_gid(ibdev, i, ini->vlan_id, ini->smcrv2.ib_gid_v2,
978 NULL, &ini->smcrv2)) {
979 ini->smcrv2.ib_dev_v2 = ibdev;
980 ini->smcrv2.ib_port_v2 = i;
981 return 0;
982 }
983 return -ENODEV;
984}
985
986/* find a roce device for the given pnetid */
987static void _smc_pnet_find_roce_by_pnetid(u8 *pnet_id,
988 struct smc_init_info *ini,
989 struct smc_ib_device *known_dev,
990 struct net *net)
991{
992 struct smc_ib_device *ibdev;
993 int i;
994
995 mutex_lock(&smc_ib_devices.mutex);
996 list_for_each_entry(ibdev, &smc_ib_devices.list, list) {
997 if (ibdev == known_dev ||
998 !rdma_dev_access_netns(ibdev->ibdev, net))
999 continue;
1000 for (i = 1; i <= SMC_MAX_PORTS; i++) {
1001 if (!rdma_is_port_valid(ibdev->ibdev, i))
1002 continue;
1003 if (smc_pnet_match(ibdev->pnetid[i - 1], pnet_id) &&
1004 smc_ib_port_active(ibdev, i) &&
1005 !test_bit(i - 1, ibdev->ports_going_away)) {
1006 if (!smc_pnet_determine_gid(ibdev, i, ini))
1007 goto out;
1008 }
1009 }
1010 }
1011out:
1012 mutex_unlock(&smc_ib_devices.mutex);
1013}
1014
1015/* find alternate roce device with same pnet_id, vlan_id and net namespace */
1016void smc_pnet_find_alt_roce(struct smc_link_group *lgr,
1017 struct smc_init_info *ini,
1018 struct smc_ib_device *known_dev)
1019{
1020 struct net *net = lgr->net;
1021
1022 _smc_pnet_find_roce_by_pnetid(lgr->pnet_id, ini, known_dev, net);
1023}
1024
1025/* if handshake network device belongs to a roce device, return its
1026 * IB device and port
1027 */
1028static void smc_pnet_find_rdma_dev(struct net_device *netdev,
1029 struct smc_init_info *ini)
1030{
1031 struct net *net = dev_net(netdev);
1032 struct smc_ib_device *ibdev;
1033
1034 mutex_lock(&smc_ib_devices.mutex);
1035 list_for_each_entry(ibdev, &smc_ib_devices.list, list) {
1036 struct net_device *ndev;
1037 int i;
1038
1039 /* check rdma net namespace */
1040 if (!rdma_dev_access_netns(ibdev->ibdev, net))
1041 continue;
1042
1043 for (i = 1; i <= SMC_MAX_PORTS; i++) {
1044 if (!rdma_is_port_valid(ibdev->ibdev, i))
1045 continue;
1046 if (!ibdev->ibdev->ops.get_netdev)
1047 continue;
1048 ndev = ibdev->ibdev->ops.get_netdev(ibdev->ibdev, i);
1049 if (!ndev)
1050 continue;
1051 dev_put(ndev);
1052 if (netdev == ndev &&
1053 smc_ib_port_active(ibdev, i) &&
1054 !test_bit(i - 1, ibdev->ports_going_away)) {
1055 if (!smc_pnet_determine_gid(ibdev, i, ini))
1056 break;
1057 }
1058 }
1059 }
1060 mutex_unlock(&smc_ib_devices.mutex);
1061}
1062
1063/* Determine the corresponding IB device port based on the hardware PNETID.
1064 * Searching stops at the first matching active IB device port with vlan_id
1065 * configured.
1066 * If nothing found, check pnetid table.
1067 * If nothing found, try to use handshake device
1068 */
1069static void smc_pnet_find_roce_by_pnetid(struct net_device *ndev,
1070 struct smc_init_info *ini)
1071{
1072 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
1073 struct net *net;
1074
1075 ndev = pnet_find_base_ndev(ndev);
1076 net = dev_net(ndev);
1077 if (smc_pnetid_by_dev_port(ndev->dev.parent, ndev->dev_port,
1078 ndev_pnetid) &&
1079 smc_pnet_find_ndev_pnetid_by_table(ndev, ndev_pnetid)) {
1080 smc_pnet_find_rdma_dev(ndev, ini);
1081 return; /* pnetid could not be determined */
1082 }
1083 _smc_pnet_find_roce_by_pnetid(ndev_pnetid, ini, NULL, net);
1084}
1085
1086static void smc_pnet_find_ism_by_pnetid(struct net_device *ndev,
1087 struct smc_init_info *ini)
1088{
1089 u8 ndev_pnetid[SMC_MAX_PNETID_LEN];
1090 struct smcd_dev *ismdev;
1091
1092 ndev = pnet_find_base_ndev(ndev);
1093 if (smc_pnetid_by_dev_port(ndev->dev.parent, ndev->dev_port,
1094 ndev_pnetid) &&
1095 smc_pnet_find_ndev_pnetid_by_table(ndev, ndev_pnetid))
1096 return; /* pnetid could not be determined */
1097
1098 mutex_lock(&smcd_dev_list.mutex);
1099 list_for_each_entry(ismdev, &smcd_dev_list.list, list) {
1100 if (smc_pnet_match(ismdev->pnetid, ndev_pnetid) &&
1101 !ismdev->going_away &&
1102 (!ini->ism_peer_gid[0] ||
1103 !smc_ism_cantalk(ini->ism_peer_gid[0], ini->vlan_id,
1104 ismdev))) {
1105 ini->ism_dev[0] = ismdev;
1106 break;
1107 }
1108 }
1109 mutex_unlock(&smcd_dev_list.mutex);
1110}
1111
1112/* PNET table analysis for a given sock:
1113 * determine ib_device and port belonging to used internal TCP socket
1114 * ethernet interface.
1115 */
1116void smc_pnet_find_roce_resource(struct sock *sk, struct smc_init_info *ini)
1117{
1118 struct dst_entry *dst = sk_dst_get(sk);
1119
1120 if (!dst)
1121 goto out;
1122 if (!dst->dev)
1123 goto out_rel;
1124
1125 smc_pnet_find_roce_by_pnetid(dst->dev, ini);
1126
1127out_rel:
1128 dst_release(dst);
1129out:
1130 return;
1131}
1132
1133void smc_pnet_find_ism_resource(struct sock *sk, struct smc_init_info *ini)
1134{
1135 struct dst_entry *dst = sk_dst_get(sk);
1136
1137 ini->ism_dev[0] = NULL;
1138 if (!dst)
1139 goto out;
1140 if (!dst->dev)
1141 goto out_rel;
1142
1143 smc_pnet_find_ism_by_pnetid(dst->dev, ini);
1144
1145out_rel:
1146 dst_release(dst);
1147out:
1148 return;
1149}
1150
1151/* Lookup and apply a pnet table entry to the given ib device.
1152 */
1153int smc_pnetid_by_table_ib(struct smc_ib_device *smcibdev, u8 ib_port)
1154{
1155 char *ib_name = smcibdev->ibdev->name;
1156 struct smc_pnettable *pnettable;
1157 struct smc_pnetentry *tmp_pe;
1158 struct smc_net *sn;
1159 int rc = -ENOENT;
1160
1161 /* get pnettable for init namespace */
1162 sn = net_generic(&init_net, smc_net_id);
1163 pnettable = &sn->pnettable;
1164
1165 mutex_lock(&pnettable->lock);
1166 list_for_each_entry(tmp_pe, &pnettable->pnetlist, list) {
1167 if (tmp_pe->type == SMC_PNET_IB &&
1168 !strncmp(tmp_pe->ib_name, ib_name, IB_DEVICE_NAME_MAX) &&
1169 tmp_pe->ib_port == ib_port) {
1170 smc_pnet_apply_ib(smcibdev, ib_port, tmp_pe->pnet_name);
1171 rc = 0;
1172 break;
1173 }
1174 }
1175 mutex_unlock(&pnettable->lock);
1176
1177 return rc;
1178}
1179
1180/* Lookup and apply a pnet table entry to the given smcd device.
1181 */
1182int smc_pnetid_by_table_smcd(struct smcd_dev *smcddev)
1183{
1184 const char *ib_name = dev_name(&smcddev->dev);
1185 struct smc_pnettable *pnettable;
1186 struct smc_pnetentry *tmp_pe;
1187 struct smc_net *sn;
1188 int rc = -ENOENT;
1189
1190 /* get pnettable for init namespace */
1191 sn = net_generic(&init_net, smc_net_id);
1192 pnettable = &sn->pnettable;
1193
1194 mutex_lock(&pnettable->lock);
1195 list_for_each_entry(tmp_pe, &pnettable->pnetlist, list) {
1196 if (tmp_pe->type == SMC_PNET_IB &&
1197 !strncmp(tmp_pe->ib_name, ib_name, IB_DEVICE_NAME_MAX)) {
1198 smc_pnet_apply_smcd(smcddev, tmp_pe->pnet_name);
1199 rc = 0;
1200 break;
1201 }
1202 }
1203 mutex_unlock(&pnettable->lock);
1204
1205 return rc;
1206}