drivers/infiniband/sw/siw/siw_main.c

   1 // SPDX-License-Identifier: GPL-2.0 or BSD-3-Clause
   2
   3 /* Authors: Bernard Metzler <bmt@zurich.ibm.com> */
   4 /* Copyright (c) 2008-2019, IBM Corporation */
   5
   6 #include <linux/init.h>
   7 #include <linux/errno.h>
   8 #include <linux/netdevice.h>
   9 #include <linux/inetdevice.h>
  10 #include <net/net_namespace.h>
  11 #include <linux/rtnetlink.h>
  12 #include <linux/if_arp.h>
  13 #include <linux/list.h>
  14 #include <linux/kernel.h>
  15 #include <linux/sched.h>
  16 #include <linux/module.h>
  17 #include <linux/dma-mapping.h>
  18
  19 #include <net/addrconf.h>
  20 #include <rdma/ib_verbs.h>
  21 #include <rdma/ib_user_verbs.h>
  22 #include <rdma/rdma_netlink.h>
  23 #include <linux/kthread.h>
  24
  25 #include "siw.h"
  26 #include "siw_verbs.h"
  27
  28 MODULE_AUTHOR("Bernard Metzler");
  29 MODULE_DESCRIPTION("Software iWARP Driver");
  30 MODULE_LICENSE("Dual BSD/GPL");
  31
  32 /* transmit from user buffer, if possible */
  33 const bool zcopy_tx = true;
  34
  35 /* Restrict usage of GSO, if hardware peer iwarp is unable to process
  36  * large packets. try_gso = true lets siw try to use local GSO,
  37  * if peer agrees.  Not using GSO severly limits siw maximum tx bandwidth.
  38  */
  39 const bool try_gso;
  40
  41 /* Attach siw also with loopback devices */
  42 const bool loopback_enabled = true;
  43
  44 /* We try to negotiate CRC on, if true */
  45 const bool mpa_crc_required;
  46
  47 /* MPA CRC on/off enforced */
  48 const bool mpa_crc_strict;
  49
  50 /* Control TCP_NODELAY socket option */
  51 const bool siw_tcp_nagle;
  52
  53 /* Select MPA version to be used during connection setup */
  54 u_char mpa_version = MPA_REVISION_2;
  55
  56 /* Selects MPA P2P mode (additional handshake during connection
  57  * setup, if true.
  58  */
  59 const bool peer_to_peer;
  60
  61 struct task_struct *siw_tx_thread[NR_CPUS];
  62 struct crypto_shash *siw_crypto_shash;
  63
  64 static int siw_device_register(struct siw_device *sdev, const char *name)
  65 {
  66         struct ib_device *base_dev = &sdev->base_dev;
  67         static int dev_id = 1;
  68         int rv;
  69
  70         sdev->vendor_part_id = dev_id++;
  71
  72         rv = ib_register_device(base_dev, name, NULL);
  73         if (rv) {
  74                 pr_warn("siw: device registration error %d\n", rv);
  75                 return rv;
  76         }
  77
  78         siw_dbg(base_dev, "HWaddr=%pM\n", sdev->netdev->dev_addr);
  79
  80         return 0;
  81 }
  82
  83 static void siw_device_cleanup(struct ib_device *base_dev)
  84 {
  85         struct siw_device *sdev = to_siw_dev(base_dev);
  86
  87         xa_destroy(&sdev->qp_xa);
  88         xa_destroy(&sdev->mem_xa);
  89 }
  90
  91 static int siw_create_tx_threads(void)
  92 {
  93         int cpu, assigned = 0;
  94
  95         for_each_online_cpu(cpu) {
  96                 /* Skip HT cores */
  97                 if (cpu % cpumask_weight(topology_sibling_cpumask(cpu)))
  98                         continue;
  99
 100                 siw_tx_thread[cpu] =
 101                         kthread_create(siw_run_sq, (unsigned long *)(long)cpu,
 102                                        "siw_tx/%d", cpu);
 103                 if (IS_ERR(siw_tx_thread[cpu])) {
 104                         siw_tx_thread[cpu] = NULL;
 105                         continue;
 106                 }
 107                 kthread_bind(siw_tx_thread[cpu], cpu);
 108
 109                 wake_up_process(siw_tx_thread[cpu]);
 110                 assigned++;
 111         }
 112         return assigned;
 113 }
 114
 115 static int siw_dev_qualified(struct net_device *netdev)
 116 {
 117         /*
 118          * Additional hardware support can be added here
 119          * (e.g. ARPHRD_FDDI, ARPHRD_ATM, ...) - see
 120          * <linux/if_arp.h> for type identifiers.
 121          */
 122         if (netdev->type == ARPHRD_ETHER || netdev->type == ARPHRD_IEEE802 ||
 123             (netdev->type == ARPHRD_LOOPBACK && loopback_enabled))
 124                 return 1;
 125
 126         return 0;
 127 }
 128
 129 static DEFINE_PER_CPU(atomic_t, siw_use_cnt);
 130
 131 static struct {
 132         struct cpumask **tx_valid_cpus;
 133         int num_nodes;
 134 } siw_cpu_info;
 135
 136 static int siw_init_cpulist(void)
 137 {
 138         int i, num_nodes = num_possible_nodes();
 139
 140         memset(siw_tx_thread, 0, sizeof(siw_tx_thread));
 141
 142         siw_cpu_info.num_nodes = num_nodes;
 143
 144         siw_cpu_info.tx_valid_cpus =
 145                 kcalloc(num_nodes, sizeof(struct cpumask *), GFP_KERNEL);
 146         if (!siw_cpu_info.tx_valid_cpus) {
 147                 siw_cpu_info.num_nodes = 0;
 148                 return -ENOMEM;
 149         }
 150         for (i = 0; i < siw_cpu_info.num_nodes; i++) {
 151                 siw_cpu_info.tx_valid_cpus[i] =
 152                         kzalloc(sizeof(struct cpumask), GFP_KERNEL);
 153                 if (!siw_cpu_info.tx_valid_cpus[i])
 154                         goto out_err;
 155
 156                 cpumask_clear(siw_cpu_info.tx_valid_cpus[i]);
 157         }
 158         for_each_possible_cpu(i)
 159                 cpumask_set_cpu(i, siw_cpu_info.tx_valid_cpus[cpu_to_node(i)]);
 160
 161         return 0;
 162
 163 out_err:
 164         siw_cpu_info.num_nodes = 0;
 165         while (--i >= 0)
 166                 kfree(siw_cpu_info.tx_valid_cpus[i]);
 167         kfree(siw_cpu_info.tx_valid_cpus);
 168         siw_cpu_info.tx_valid_cpus = NULL;
 169
 170         return -ENOMEM;
 171 }
 172
 173 static void siw_destroy_cpulist(void)
 174 {
 175         int i = 0;
 176
 177         while (i < siw_cpu_info.num_nodes)
 178                 kfree(siw_cpu_info.tx_valid_cpus[i++]);
 179
 180         kfree(siw_cpu_info.tx_valid_cpus);
 181 }
 182
 183 /*
 184  * Choose CPU with least number of active QP's from NUMA node of
 185  * TX interface.
 186  */
 187 int siw_get_tx_cpu(struct siw_device *sdev)
 188 {
 189         const struct cpumask *tx_cpumask;
 190         int i, num_cpus, cpu, min_use, node = sdev->numa_node, tx_cpu = -1;
 191
 192         if (node < 0)
 193                 tx_cpumask = cpu_online_mask;
 194         else
 195                 tx_cpumask = siw_cpu_info.tx_valid_cpus[node];
 196
 197         num_cpus = cpumask_weight(tx_cpumask);
 198         if (!num_cpus) {
 199                 /* no CPU on this NUMA node */
 200                 tx_cpumask = cpu_online_mask;
 201                 num_cpus = cpumask_weight(tx_cpumask);
 202         }
 203         if (!num_cpus)
 204                 goto out;
 205
 206         cpu = cpumask_first(tx_cpumask);
 207
 208         for (i = 0, min_use = SIW_MAX_QP; i < num_cpus;
 209              i++, cpu = cpumask_next(cpu, tx_cpumask)) {
 210                 int usage;
 211
 212                 /* Skip any cores which have no TX thread */
 213                 if (!siw_tx_thread[cpu])
 214                         continue;
 215
 216                 usage = atomic_read(&per_cpu(siw_use_cnt, cpu));
 217                 if (usage <= min_use) {
 218                         tx_cpu = cpu;
 219                         min_use = usage;
 220                 }
 221         }
 222         siw_dbg(&sdev->base_dev,
 223                 "tx cpu %d, node %d, %d qp's\n", tx_cpu, node, min_use);
 224
 225 out:
 226         if (tx_cpu >= 0)
 227                 atomic_inc(&per_cpu(siw_use_cnt, tx_cpu));
 228         else
 229                 pr_warn("siw: no tx cpu found\n");
 230
 231         return tx_cpu;
 232 }
 233
 234 void siw_put_tx_cpu(int cpu)
 235 {
 236         atomic_dec(&per_cpu(siw_use_cnt, cpu));
 237 }
 238
 239 static struct ib_qp *siw_get_base_qp(struct ib_device *base_dev, int id)
 240 {
 241         struct siw_qp *qp = siw_qp_id2obj(to_siw_dev(base_dev), id);
 242
 243         if (qp) {
 244                 /*
 245                  * siw_qp_id2obj() increments object reference count
 246                  */
 247                 siw_qp_put(qp);
 248                 return &qp->base_qp;
 249         }
 250         return NULL;
 251 }
 252
 253 static const struct ib_device_ops siw_device_ops = {
 254         .owner = THIS_MODULE,
 255         .uverbs_abi_ver = SIW_ABI_VERSION,
 256         .driver_id = RDMA_DRIVER_SIW,
 257
 258         .alloc_mr = siw_alloc_mr,
 259         .alloc_pd = siw_alloc_pd,
 260         .alloc_ucontext = siw_alloc_ucontext,
 261         .create_cq = siw_create_cq,
 262         .create_qp = siw_create_qp,
 263         .create_srq = siw_create_srq,
 264         .dealloc_driver = siw_device_cleanup,
 265         .dealloc_pd = siw_dealloc_pd,
 266         .dealloc_ucontext = siw_dealloc_ucontext,
 267         .dereg_mr = siw_dereg_mr,
 268         .destroy_cq = siw_destroy_cq,
 269         .destroy_qp = siw_destroy_qp,
 270         .destroy_srq = siw_destroy_srq,
 271         .get_dma_mr = siw_get_dma_mr,
 272         .get_port_immutable = siw_get_port_immutable,
 273         .iw_accept = siw_accept,
 274         .iw_add_ref = siw_qp_get_ref,
 275         .iw_connect = siw_connect,
 276         .iw_create_listen = siw_create_listen,
 277         .iw_destroy_listen = siw_destroy_listen,
 278         .iw_get_qp = siw_get_base_qp,
 279         .iw_reject = siw_reject,
 280         .iw_rem_ref = siw_qp_put_ref,
 281         .map_mr_sg = siw_map_mr_sg,
 282         .mmap = siw_mmap,
 283         .mmap_free = siw_mmap_free,
 284         .modify_qp = siw_verbs_modify_qp,
 285         .modify_srq = siw_modify_srq,
 286         .poll_cq = siw_poll_cq,
 287         .post_recv = siw_post_receive,
 288         .post_send = siw_post_send,
 289         .post_srq_recv = siw_post_srq_recv,
 290         .query_device = siw_query_device,
 291         .query_gid = siw_query_gid,
 292         .query_port = siw_query_port,
 293         .query_qp = siw_query_qp,
 294         .query_srq = siw_query_srq,
 295         .req_notify_cq = siw_req_notify_cq,
 296         .reg_user_mr = siw_reg_user_mr,
 297
 298         INIT_RDMA_OBJ_SIZE(ib_cq, siw_cq, base_cq),
 299         INIT_RDMA_OBJ_SIZE(ib_pd, siw_pd, base_pd),
 300         INIT_RDMA_OBJ_SIZE(ib_srq, siw_srq, base_srq),
 301         INIT_RDMA_OBJ_SIZE(ib_ucontext, siw_ucontext, base_ucontext),
 302 };
 303
 304 static struct siw_device *siw_device_create(struct net_device *netdev)
 305 {
 306         struct siw_device *sdev = NULL;
 307         struct ib_device *base_dev;
 308         int rv;
 309
 310         sdev = ib_alloc_device(siw_device, base_dev);
 311         if (!sdev)
 312                 return NULL;
 313
 314         base_dev = &sdev->base_dev;
 315
 316         sdev->netdev = netdev;
 317
 318         if (netdev->type != ARPHRD_LOOPBACK) {
 319                 addrconf_addr_eui48((unsigned char *)&base_dev->node_guid,
 320                                     netdev->dev_addr);
 321         } else {
 322                 /*
 323                  * The loopback device does not have a HW address,
 324                  * but connection mangagement lib expects gid != 0
 325                  */
 326                 size_t len = min_t(size_t, strlen(base_dev->name), 6);
 327                 char addr[6] = { };
 328
 329                 memcpy(addr, base_dev->name, len);
 330                 addrconf_addr_eui48((unsigned char *)&base_dev->node_guid,
 331                                     addr);
 332         }
 333
 334         base_dev->uverbs_cmd_mask |= BIT_ULL(IB_USER_VERBS_CMD_POST_SEND);
 335
 336         base_dev->node_type = RDMA_NODE_RNIC;
 337         memcpy(base_dev->node_desc, SIW_NODE_DESC_COMMON,
 338                sizeof(SIW_NODE_DESC_COMMON));
 339
 340         /*
 341          * Current model (one-to-one device association):
 342          * One Softiwarp device per net_device or, equivalently,
 343          * per physical port.
 344          */
 345         base_dev->phys_port_cnt = 1;
 346         base_dev->num_comp_vectors = num_possible_cpus();
 347
 348         xa_init_flags(&sdev->qp_xa, XA_FLAGS_ALLOC1);
 349         xa_init_flags(&sdev->mem_xa, XA_FLAGS_ALLOC1);
 350
 351         ib_set_device_ops(base_dev, &siw_device_ops);
 352         rv = ib_device_set_netdev(base_dev, netdev, 1);
 353         if (rv)
 354                 goto error;
 355
 356         memcpy(base_dev->iw_ifname, netdev->name,
 357                sizeof(base_dev->iw_ifname));
 358
 359         /* Disable TCP port mapping */
 360         base_dev->iw_driver_flags = IW_F_NO_PORT_MAP,
 361
 362         sdev->attrs.max_qp = SIW_MAX_QP;
 363         sdev->attrs.max_qp_wr = SIW_MAX_QP_WR;
 364         sdev->attrs.max_ord = SIW_MAX_ORD_QP;
 365         sdev->attrs.max_ird = SIW_MAX_IRD_QP;
 366         sdev->attrs.max_sge = SIW_MAX_SGE;
 367         sdev->attrs.max_sge_rd = SIW_MAX_SGE_RD;
 368         sdev->attrs.max_cq = SIW_MAX_CQ;
 369         sdev->attrs.max_cqe = SIW_MAX_CQE;
 370         sdev->attrs.max_mr = SIW_MAX_MR;
 371         sdev->attrs.max_pd = SIW_MAX_PD;
 372         sdev->attrs.max_mw = SIW_MAX_MW;
 373         sdev->attrs.max_srq = SIW_MAX_SRQ;
 374         sdev->attrs.max_srq_wr = SIW_MAX_SRQ_WR;
 375         sdev->attrs.max_srq_sge = SIW_MAX_SGE;
 376
 377         INIT_LIST_HEAD(&sdev->cep_list);
 378         INIT_LIST_HEAD(&sdev->qp_list);
 379
 380         atomic_set(&sdev->num_ctx, 0);
 381         atomic_set(&sdev->num_srq, 0);
 382         atomic_set(&sdev->num_qp, 0);
 383         atomic_set(&sdev->num_cq, 0);
 384         atomic_set(&sdev->num_mr, 0);
 385         atomic_set(&sdev->num_pd, 0);
 386
 387         sdev->numa_node = dev_to_node(&netdev->dev);
 388         spin_lock_init(&sdev->lock);
 389
 390         return sdev;
 391 error:
 392         ib_dealloc_device(base_dev);
 393
 394         return NULL;
 395 }
 396
 397 /*
 398  * Network link becomes unavailable. Mark all
 399  * affected QP's accordingly.
 400  */
 401 static void siw_netdev_down(struct work_struct *work)
 402 {
 403         struct siw_device *sdev =
 404                 container_of(work, struct siw_device, netdev_down);
 405
 406         struct siw_qp_attrs qp_attrs;
 407         struct list_head *pos, *tmp;
 408
 409         memset(&qp_attrs, 0, sizeof(qp_attrs));
 410         qp_attrs.state = SIW_QP_STATE_ERROR;
 411
 412         list_for_each_safe(pos, tmp, &sdev->qp_list) {
 413                 struct siw_qp *qp = list_entry(pos, struct siw_qp, devq);
 414
 415                 down_write(&qp->state_lock);
 416                 WARN_ON(siw_qp_modify(qp, &qp_attrs, SIW_QP_ATTR_STATE));
 417                 up_write(&qp->state_lock);
 418         }
 419         ib_device_put(&sdev->base_dev);
 420 }
 421
 422 static void siw_device_goes_down(struct siw_device *sdev)
 423 {
 424         if (ib_device_try_get(&sdev->base_dev)) {
 425                 INIT_WORK(&sdev->netdev_down, siw_netdev_down);
 426                 schedule_work(&sdev->netdev_down);
 427         }
 428 }
 429
 430 static int siw_netdev_event(struct notifier_block *nb, unsigned long event,
 431                             void *arg)
 432 {
 433         struct net_device *netdev = netdev_notifier_info_to_dev(arg);
 434         struct ib_device *base_dev;
 435         struct siw_device *sdev;
 436
 437         dev_dbg(&netdev->dev, "siw: event %lu\n", event);
 438
 439         if (dev_net(netdev) != &init_net)
 440                 return NOTIFY_OK;
 441
 442         base_dev = ib_device_get_by_netdev(netdev, RDMA_DRIVER_SIW);
 443         if (!base_dev)
 444                 return NOTIFY_OK;
 445
 446         sdev = to_siw_dev(base_dev);
 447
 448         switch (event) {
 449         case NETDEV_UP:
 450                 sdev->state = IB_PORT_ACTIVE;
 451                 siw_port_event(sdev, 1, IB_EVENT_PORT_ACTIVE);
 452                 break;
 453
 454         case NETDEV_GOING_DOWN:
 455                 siw_device_goes_down(sdev);
 456                 break;
 457
 458         case NETDEV_DOWN:
 459                 sdev->state = IB_PORT_DOWN;
 460                 siw_port_event(sdev, 1, IB_EVENT_PORT_ERR);
 461                 break;
 462
 463         case NETDEV_REGISTER:
 464                 /*
 465                  * Device registration now handled only by
 466                  * rdma netlink commands. So it shall be impossible
 467                  * to end up here with a valid siw device.
 468                  */
 469                 siw_dbg(base_dev, "unexpected NETDEV_REGISTER event\n");
 470                 break;
 471
 472         case NETDEV_UNREGISTER:
 473                 ib_unregister_device_queued(&sdev->base_dev);
 474                 break;
 475
 476         case NETDEV_CHANGEADDR:
 477                 siw_port_event(sdev, 1, IB_EVENT_LID_CHANGE);
 478                 break;
 479         /*
 480          * Todo: Below netdev events are currently not handled.
 481          */
 482         case NETDEV_CHANGEMTU:
 483         case NETDEV_CHANGE:
 484                 break;
 485
 486         default:
 487                 break;
 488         }
 489         ib_device_put(&sdev->base_dev);
 490
 491         return NOTIFY_OK;
 492 }
 493
 494 static struct notifier_block siw_netdev_nb = {
 495         .notifier_call = siw_netdev_event,
 496 };
 497
 498 static int siw_newlink(const char *basedev_name, struct net_device *netdev)
 499 {
 500         struct ib_device *base_dev;
 501         struct siw_device *sdev = NULL;
 502         int rv = -ENOMEM;
 503
 504         if (!siw_dev_qualified(netdev))
 505                 return -EINVAL;
 506
 507         base_dev = ib_device_get_by_netdev(netdev, RDMA_DRIVER_SIW);
 508         if (base_dev) {
 509                 ib_device_put(base_dev);
 510                 return -EEXIST;
 511         }
 512         sdev = siw_device_create(netdev);
 513         if (sdev) {
 514                 dev_dbg(&netdev->dev, "siw: new device\n");
 515
 516                 if (netif_running(netdev) && netif_carrier_ok(netdev))
 517                         sdev->state = IB_PORT_ACTIVE;
 518                 else
 519                         sdev->state = IB_PORT_DOWN;
 520
 521                 rv = siw_device_register(sdev, basedev_name);
 522                 if (rv)
 523                         ib_dealloc_device(&sdev->base_dev);
 524         }
 525         return rv;
 526 }
 527
 528 static struct rdma_link_ops siw_link_ops = {
 529         .type = "siw",
 530         .newlink = siw_newlink,
 531 };
 532
 533 /*
 534  * siw_init_module - Initialize Softiwarp module and register with netdev
 535  *                   subsystem.
 536  */
 537 static __init int siw_init_module(void)
 538 {
 539         int rv;
 540         int nr_cpu;
 541
 542         if (SENDPAGE_THRESH < SIW_MAX_INLINE) {
 543                 pr_info("siw: sendpage threshold too small: %u\n",
 544                         (int)SENDPAGE_THRESH);
 545                 rv = -EINVAL;
 546                 goto out_error;
 547         }
 548         rv = siw_init_cpulist();
 549         if (rv)
 550                 goto out_error;
 551
 552         rv = siw_cm_init();
 553         if (rv)
 554                 goto out_error;
 555
 556         if (!siw_create_tx_threads()) {
 557                 pr_info("siw: Could not start any TX thread\n");
 558                 rv = -ENOMEM;
 559                 goto out_error;
 560         }
 561         /*
 562          * Locate CRC32 algorithm. If unsuccessful, fail
 563          * loading siw only, if CRC is required.
 564          */
 565         siw_crypto_shash = crypto_alloc_shash("crc32c", 0, 0);
 566         if (IS_ERR(siw_crypto_shash)) {
 567                 pr_info("siw: Loading CRC32c failed: %ld\n",
 568                         PTR_ERR(siw_crypto_shash));
 569                 siw_crypto_shash = NULL;
 570                 if (mpa_crc_required) {
 571                         rv = -EOPNOTSUPP;
 572                         goto out_error;
 573                 }
 574         }
 575         rv = register_netdevice_notifier(&siw_netdev_nb);
 576         if (rv)
 577                 goto out_error;
 578
 579         rdma_link_register(&siw_link_ops);
 580
 581         pr_info("SoftiWARP attached\n");
 582         return 0;
 583
 584 out_error:
 585         for (nr_cpu = 0; nr_cpu < nr_cpu_ids; nr_cpu++) {
 586                 if (siw_tx_thread[nr_cpu]) {
 587                         siw_stop_tx_thread(nr_cpu);
 588                         siw_tx_thread[nr_cpu] = NULL;
 589                 }
 590         }
 591         if (siw_crypto_shash)
 592                 crypto_free_shash(siw_crypto_shash);
 593
 594         pr_info("SoftIWARP attach failed. Error: %d\n", rv);
 595
 596         siw_cm_exit();
 597         siw_destroy_cpulist();
 598
 599         return rv;
 600 }
 601
 602 static void __exit siw_exit_module(void)
 603 {
 604         int cpu;
 605
 606         for_each_possible_cpu(cpu) {
 607                 if (siw_tx_thread[cpu]) {
 608                         siw_stop_tx_thread(cpu);
 609                         siw_tx_thread[cpu] = NULL;
 610                 }
 611         }
 612         unregister_netdevice_notifier(&siw_netdev_nb);
 613         rdma_link_unregister(&siw_link_ops);
 614         ib_unregister_driver(RDMA_DRIVER_SIW);
 615
 616         siw_cm_exit();
 617
 618         siw_destroy_cpulist();
 619
 620         if (siw_crypto_shash)
 621                 crypto_free_shash(siw_crypto_shash);
 622
 623         pr_info("SoftiWARP detached\n");
 624 }
 625
 626 module_init(siw_init_module);
 627 module_exit(siw_exit_module);
 628
 629 MODULE_ALIAS_RDMA_LINK("siw");