linux/net/smc/smc_pnet.c
<<
>>
Prefs
   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 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                };
  68                struct {
  69                        char ib_name[IB_DEVICE_NAME_MAX + 1];
  70                        u8 ib_port;
  71                };
  72        };
  73};
  74
  75/* Check if the pnetid is set */
  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/* Check if two given pnetids match */
  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/* Remove a pnetid from the pnet table.
  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        /* get pnettable for namespace */
 111        sn = net_generic(net, smc_net_id);
 112        pnettable = &sn->pnettable;
 113
 114        /* remove table entry */
 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        /* if this is not the initial namespace, stop here */
 136        if (net != &init_net)
 137                return rc;
 138
 139        /* remove ib devices */
 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        /* remove smcd devices */
 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/* Add the reference to a given network device to the pnet table.
 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        /* get pnettable for namespace */
 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/* Remove the reference to a given network device from the pnet table.
 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        /* get pnettable for namespace */
 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/* Apply pnetid to ib device when no pnetid is set.
 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/* Apply pnetid to smcd device when no pnetid is set.
 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/* The limit for pnetid is 16 characters.
 278 * Valid characters should be (single-byte character set) a-z, A-Z, 0-9.
 279 * Lower case letters are converted to upper case.
 280 * Interior blanks should not be used.
 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/* Find an infiniband device by a given name. The device might not exist. */
 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/* Find an smcd device by a given name. The device might not exist. */
 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        /* check if (base) netdev already has a pnetid. If there is one, we do
 351         * not want to add a pnet table entry
 352         */
 353        rc = -EEXIST;
 354        ndev = dev_get_by_name(net, eth_name);  /* dev_hold() */
 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        /* add a new netdev entry to the pnet table if there isn't one */
 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        /* try to apply the pnetid to active devices */
 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        /* Apply fails when a device has a hardware-defined pnetid set, do not
 433         * add a pnet table entry in that case.
 434         */
 435        if (!ibdev_applied || !smcddev_applied)
 436                return -EEXIST;
 437
 438        /* add a new ib entry to the pnet table if there isn't one */
 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/* Append a pnetid to the end of the pnet table if not already on this list.
 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        /* get pnettable for namespace */
 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        /* if this is not the initial namespace, stop here */
 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/* Convert an smc_pnetentry to a netlink attribute sequence */
 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        /* get pnettable for namespace */
 601        sn = net_generic(net, smc_net_id);
 602        pnettable = &sn->pnettable;
 603
 604        /* dump pnettable entries */
 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                /* if this is not the initial namespace, dump only netdev */
 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/* Retrieve one PNETID entry */
 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        /* finish multi part message and send it */
 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/* Remove and delete all pnetids from pnet table.
 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/* SMC_PNETID generic netlink operation definition */
 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                /* can be retrieved by unprivileged users */
 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/* SMC_PNETID family definition */
 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                /* add to PNETIDs list */
 789                smc_pnet_add_pnetid(net, ndev_pnetid);
 790        }
 791}
 792
 793/* create initial list of netdevice pnetids */
 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/* clean up list of netdevice pnetids */
 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                        /* remove from PNETIDs list */
 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/* init network namespace */
 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/* exit network namespace */
 888void smc_pnet_net_exit(struct net *net)
 889{
 890        /* flush pnet table */
 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/* Determine one base device for stacked net devices.
 919 * If the lower device level contains more than one devices
 920 * (for instance with bonding slaves), just the first device
 921 * is used to reach a base device.
 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        /* get pnettable for namespace */
 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                        /* get pnetid of netdev device */
 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/* find a roce device for the given pnetid */
 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/* find alternate roce device with same pnet_id and vlan_id */
 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/* if handshake network device belongs to a roce device, return its
 997 * IB device and port
 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/* Determine the corresponding IB device port based on the hardware PNETID.
1033 * Searching stops at the first matching active IB device port with vlan_id
1034 * configured.
1035 * If nothing found, check pnetid table.
1036 * If nothing found, try to use handshake device
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; /* pnetid could not be determined */
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; /* pnetid could not be determined */
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/* PNET table analysis for a given sock:
1080 * determine ib_device and port belonging to used internal TCP socket
1081 * ethernet interface.
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/* Lookup and apply a pnet table entry to the given ib device.
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        /* get pnettable for init namespace */
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/* Lookup and apply a pnet table entry to the given smcd device.
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        /* get pnettable for init namespace */
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