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