drivers/infiniband/core/device.c

   1 /*
   2  * Copyright (c) 2004 Topspin Communications.  All rights reserved.
   3  * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved.
   4  *
   5  * This software is available to you under a choice of one of two
   6  * licenses.  You may choose to be licensed under the terms of the GNU
   7  * General Public License (GPL) Version 2, available from the file
   8  * COPYING in the main directory of this source tree, or the
   9  * OpenIB.org BSD license below:
  10  *
  11  *     Redistribution and use in source and binary forms, with or
  12  *     without modification, are permitted provided that the following
  13  *     conditions are met:
  14  *
  15  *      - Redistributions of source code must retain the above
  16  *        copyright notice, this list of conditions and the following
  17  *        disclaimer.
  18  *
  19  *      - Redistributions in binary form must reproduce the above
  20  *        copyright notice, this list of conditions and the following
  21  *        disclaimer in the documentation and/or other materials
  22  *        provided with the distribution.
  23  *
  24  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  25  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  26  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  27  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  28  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  29  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  30  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  31  * SOFTWARE.
  32  */
  33
  34 #include <linux/module.h>
  35 #include <linux/string.h>
  36 #include <linux/errno.h>
  37 #include <linux/kernel.h>
  38 #include <linux/slab.h>
  39 #include <linux/init.h>
  40 #include <linux/mutex.h>
  41 #include <linux/netdevice.h>
  42 #include <rdma/rdma_netlink.h>
  43 #include <rdma/ib_addr.h>
  44 #include <rdma/ib_cache.h>
  45
  46 #include "core_priv.h"
  47
  48 MODULE_AUTHOR("Roland Dreier");
  49 MODULE_DESCRIPTION("core kernel InfiniBand API");
  50 MODULE_LICENSE("Dual BSD/GPL");
  51
  52 struct ib_client_data {
  53         struct list_head  list;
  54         struct ib_client *client;
  55         void *            data;
  56         /* The device or client is going down. Do not call client or device
  57          * callbacks other than remove(). */
  58         bool              going_down;
  59 };
  60
  61 struct workqueue_struct *ib_comp_wq;
  62 struct workqueue_struct *ib_comp_unbound_wq;
  63 struct workqueue_struct *ib_wq;
  64 EXPORT_SYMBOL_GPL(ib_wq);
  65
  66 /* The device_list and client_list contain devices and clients after their
  67  * registration has completed, and the devices and clients are removed
  68  * during unregistration. */
  69 static LIST_HEAD(device_list);
  70 static LIST_HEAD(client_list);
  71
  72 /*
  73  * device_mutex and lists_rwsem protect access to both device_list and
  74  * client_list.  device_mutex protects writer access by device and client
  75  * registration / de-registration.  lists_rwsem protects reader access to
  76  * these lists.  Iterators of these lists must lock it for read, while updates
  77  * to the lists must be done with a write lock. A special case is when the
  78  * device_mutex is locked. In this case locking the lists for read access is
  79  * not necessary as the device_mutex implies it.
  80  *
  81  * lists_rwsem also protects access to the client data list.
  82  */
  83 static DEFINE_MUTEX(device_mutex);
  84 static DECLARE_RWSEM(lists_rwsem);
  85
  86
  87 static int ib_device_check_mandatory(struct ib_device *device)
  88 {
  89 #define IB_MANDATORY_FUNC(x) { offsetof(struct ib_device, x), #x }
  90         static const struct {
  91                 size_t offset;
  92                 char  *name;
  93         } mandatory_table[] = {
  94                 IB_MANDATORY_FUNC(query_device),
  95                 IB_MANDATORY_FUNC(query_port),
  96                 IB_MANDATORY_FUNC(query_pkey),
  97                 IB_MANDATORY_FUNC(query_gid),
  98                 IB_MANDATORY_FUNC(alloc_pd),
  99                 IB_MANDATORY_FUNC(dealloc_pd),
 100                 IB_MANDATORY_FUNC(create_ah),
 101                 IB_MANDATORY_FUNC(destroy_ah),
 102                 IB_MANDATORY_FUNC(create_qp),
 103                 IB_MANDATORY_FUNC(modify_qp),
 104                 IB_MANDATORY_FUNC(destroy_qp),
 105                 IB_MANDATORY_FUNC(post_send),
 106                 IB_MANDATORY_FUNC(post_recv),
 107                 IB_MANDATORY_FUNC(create_cq),
 108                 IB_MANDATORY_FUNC(destroy_cq),
 109                 IB_MANDATORY_FUNC(poll_cq),
 110                 IB_MANDATORY_FUNC(req_notify_cq),
 111                 IB_MANDATORY_FUNC(get_dma_mr),
 112                 IB_MANDATORY_FUNC(dereg_mr),
 113                 IB_MANDATORY_FUNC(get_port_immutable)
 114         };
 115         int i;
 116
 117         for (i = 0; i < ARRAY_SIZE(mandatory_table); ++i) {
 118                 if (!*(void **) ((void *) device + mandatory_table[i].offset)) {
 119                         pr_warn("Device %s is missing mandatory function %s\n",
 120                                 device->name, mandatory_table[i].name);
 121                         return -EINVAL;
 122                 }
 123         }
 124
 125         return 0;
 126 }
 127
 128 static struct ib_device *__ib_device_get_by_name(const char *name)
 129 {
 130         struct ib_device *device;
 131
 132         list_for_each_entry(device, &device_list, core_list)
 133                 if (!strncmp(name, device->name, IB_DEVICE_NAME_MAX))
 134                         return device;
 135
 136         return NULL;
 137 }
 138
 139
 140 static int alloc_name(char *name)
 141 {
 142         unsigned long *inuse;
 143         char buf[IB_DEVICE_NAME_MAX];
 144         struct ib_device *device;
 145         int i;
 146
 147         inuse = (unsigned long *) get_zeroed_page(GFP_KERNEL);
 148         if (!inuse)
 149                 return -ENOMEM;
 150
 151         list_for_each_entry(device, &device_list, core_list) {
 152                 if (!sscanf(device->name, name, &i))
 153                         continue;
 154                 if (i < 0 || i >= PAGE_SIZE * 8)
 155                         continue;
 156                 snprintf(buf, sizeof buf, name, i);
 157                 if (!strncmp(buf, device->name, IB_DEVICE_NAME_MAX))
 158                         set_bit(i, inuse);
 159         }
 160
 161         i = find_first_zero_bit(inuse, PAGE_SIZE * 8);
 162         free_page((unsigned long) inuse);
 163         snprintf(buf, sizeof buf, name, i);
 164
 165         if (__ib_device_get_by_name(buf))
 166                 return -ENFILE;
 167
 168         strlcpy(name, buf, IB_DEVICE_NAME_MAX);
 169         return 0;
 170 }
 171
 172 static void ib_device_release(struct device *device)
 173 {
 174         struct ib_device *dev = container_of(device, struct ib_device, dev);
 175
 176         ib_cache_release_one(dev);
 177         kfree(dev->port_immutable);
 178         kfree(dev);
 179 }
 180
 181 static int ib_device_uevent(struct device *device,
 182                             struct kobj_uevent_env *env)
 183 {
 184         struct ib_device *dev = container_of(device, struct ib_device, dev);
 185
 186         if (add_uevent_var(env, "NAME=%s", dev->name))
 187                 return -ENOMEM;
 188
 189         /*
 190          * It would be nice to pass the node GUID with the event...
 191          */
 192
 193         return 0;
 194 }
 195
 196 static struct class ib_class = {
 197         .name    = "infiniband",
 198         .dev_release = ib_device_release,
 199         .dev_uevent = ib_device_uevent,
 200 };
 201
 202 /**
 203  * ib_alloc_device - allocate an IB device struct
 204  * @size:size of structure to allocate
 205  *
 206  * Low-level drivers should use ib_alloc_device() to allocate &struct
 207  * ib_device.  @size is the size of the structure to be allocated,
 208  * including any private data used by the low-level driver.
 209  * ib_dealloc_device() must be used to free structures allocated with
 210  * ib_alloc_device().
 211  */
 212 struct ib_device *ib_alloc_device(size_t size)
 213 {
 214         struct ib_device *device;
 215
 216         if (WARN_ON(size < sizeof(struct ib_device)))
 217                 return NULL;
 218
 219         device = kzalloc(size, GFP_KERNEL);
 220         if (!device)
 221                 return NULL;
 222
 223         device->dev.class = &ib_class;
 224         device_initialize(&device->dev);
 225
 226         dev_set_drvdata(&device->dev, device);
 227
 228         INIT_LIST_HEAD(&device->event_handler_list);
 229         spin_lock_init(&device->event_handler_lock);
 230         spin_lock_init(&device->client_data_lock);
 231         INIT_LIST_HEAD(&device->client_data_list);
 232         INIT_LIST_HEAD(&device->port_list);
 233
 234         return device;
 235 }
 236 EXPORT_SYMBOL(ib_alloc_device);
 237
 238 /**
 239  * ib_dealloc_device - free an IB device struct
 240  * @device:structure to free
 241  *
 242  * Free a structure allocated with ib_alloc_device().
 243  */
 244 void ib_dealloc_device(struct ib_device *device)
 245 {
 246         WARN_ON(device->reg_state != IB_DEV_UNREGISTERED &&
 247                 device->reg_state != IB_DEV_UNINITIALIZED);
 248         kobject_put(&device->dev.kobj);
 249 }
 250 EXPORT_SYMBOL(ib_dealloc_device);
 251
 252 static int add_client_context(struct ib_device *device, struct ib_client *client)
 253 {
 254         struct ib_client_data *context;
 255         unsigned long flags;
 256
 257         context = kmalloc(sizeof *context, GFP_KERNEL);
 258         if (!context) {
 259                 pr_warn("Couldn't allocate client context for %s/%s\n",
 260                         device->name, client->name);
 261                 return -ENOMEM;
 262         }
 263
 264         context->client = client;
 265         context->data   = NULL;
 266         context->going_down = false;
 267
 268         down_write(&lists_rwsem);
 269         spin_lock_irqsave(&device->client_data_lock, flags);
 270         list_add(&context->list, &device->client_data_list);
 271         spin_unlock_irqrestore(&device->client_data_lock, flags);
 272         up_write(&lists_rwsem);
 273
 274         return 0;
 275 }
 276
 277 static int verify_immutable(const struct ib_device *dev, u8 port)
 278 {
 279         return WARN_ON(!rdma_cap_ib_mad(dev, port) &&
 280                             rdma_max_mad_size(dev, port) != 0);
 281 }
 282
 283 static int read_port_immutable(struct ib_device *device)
 284 {
 285         int ret;
 286         u8 start_port = rdma_start_port(device);
 287         u8 end_port = rdma_end_port(device);
 288         u8 port;
 289
 290         /**
 291          * device->port_immutable is indexed directly by the port number to make
 292          * access to this data as efficient as possible.
 293          *
 294          * Therefore port_immutable is declared as a 1 based array with
 295          * potential empty slots at the beginning.
 296          */
 297         device->port_immutable = kzalloc(sizeof(*device->port_immutable)
 298                                          * (end_port + 1),
 299                                          GFP_KERNEL);
 300         if (!device->port_immutable)
 301                 return -ENOMEM;
 302
 303         for (port = start_port; port <= end_port; ++port) {
 304                 ret = device->get_port_immutable(device, port,
 305                                                  &device->port_immutable[port]);
 306                 if (ret)
 307                         return ret;
 308
 309                 if (verify_immutable(device, port))
 310                         return -EINVAL;
 311         }
 312         return 0;
 313 }
 314
 315 void ib_get_device_fw_str(struct ib_device *dev, char *str, size_t str_len)
 316 {
 317         if (dev->get_dev_fw_str)
 318                 dev->get_dev_fw_str(dev, str, str_len);
 319         else
 320                 str[0] = '\0';
 321 }
 322 EXPORT_SYMBOL(ib_get_device_fw_str);
 323
 324 /**
 325  * ib_register_device - Register an IB device with IB core
 326  * @device:Device to register
 327  *
 328  * Low-level drivers use ib_register_device() to register their
 329  * devices with the IB core.  All registered clients will receive a
 330  * callback for each device that is added. @device must be allocated
 331  * with ib_alloc_device().
 332  */
 333 int ib_register_device(struct ib_device *device,
 334                        int (*port_callback)(struct ib_device *,
 335                                             u8, struct kobject *))
 336 {
 337         int ret;
 338         struct ib_client *client;
 339         struct ib_udata uhw = {.outlen = 0, .inlen = 0};
 340
 341         mutex_lock(&device_mutex);
 342
 343         if (strchr(device->name, '%')) {
 344                 ret = alloc_name(device->name);
 345                 if (ret)
 346                         goto out;
 347         }
 348
 349         if (ib_device_check_mandatory(device)) {
 350                 ret = -EINVAL;
 351                 goto out;
 352         }
 353
 354         ret = read_port_immutable(device);
 355         if (ret) {
 356                 pr_warn("Couldn't create per port immutable data %s\n",
 357                         device->name);
 358                 goto out;
 359         }
 360
 361         ret = ib_cache_setup_one(device);
 362         if (ret) {
 363                 pr_warn("Couldn't set up InfiniBand P_Key/GID cache\n");
 364                 goto out;
 365         }
 366
 367         memset(&device->attrs, 0, sizeof(device->attrs));
 368         ret = device->query_device(device, &device->attrs, &uhw);
 369         if (ret) {
 370                 pr_warn("Couldn't query the device attributes\n");
 371                 ib_cache_cleanup_one(device);
 372                 goto out;
 373         }
 374
 375         ret = ib_device_register_sysfs(device, port_callback);
 376         if (ret) {
 377                 pr_warn("Couldn't register device %s with driver model\n",
 378                         device->name);
 379                 ib_cache_cleanup_one(device);
 380                 goto out;
 381         }
 382
 383         device->reg_state = IB_DEV_REGISTERED;
 384
 385         list_for_each_entry(client, &client_list, list)
 386                 if (client->add && !add_client_context(device, client))
 387                         client->add(device);
 388
 389         down_write(&lists_rwsem);
 390         list_add_tail(&device->core_list, &device_list);
 391         up_write(&lists_rwsem);
 392 out:
 393         mutex_unlock(&device_mutex);
 394         return ret;
 395 }
 396 EXPORT_SYMBOL(ib_register_device);
 397
 398 /**
 399  * ib_unregister_device - Unregister an IB device
 400  * @device:Device to unregister
 401  *
 402  * Unregister an IB device.  All clients will receive a remove callback.
 403  */
 404 void ib_unregister_device(struct ib_device *device)
 405 {
 406         struct ib_client_data *context, *tmp;
 407         unsigned long flags;
 408
 409         mutex_lock(&device_mutex);
 410
 411         down_write(&lists_rwsem);
 412         list_del(&device->core_list);
 413         spin_lock_irqsave(&device->client_data_lock, flags);
 414         list_for_each_entry_safe(context, tmp, &device->client_data_list, list)
 415                 context->going_down = true;
 416         spin_unlock_irqrestore(&device->client_data_lock, flags);
 417         downgrade_write(&lists_rwsem);
 418
 419         list_for_each_entry_safe(context, tmp, &device->client_data_list,
 420                                  list) {
 421                 if (context->client->remove)
 422                         context->client->remove(device, context->data);
 423         }
 424         up_read(&lists_rwsem);
 425
 426         mutex_unlock(&device_mutex);
 427
 428         ib_device_unregister_sysfs(device);
 429         ib_cache_cleanup_one(device);
 430
 431         down_write(&lists_rwsem);
 432         spin_lock_irqsave(&device->client_data_lock, flags);
 433         list_for_each_entry_safe(context, tmp, &device->client_data_list, list)
 434                 kfree(context);
 435         spin_unlock_irqrestore(&device->client_data_lock, flags);
 436         up_write(&lists_rwsem);
 437
 438         device->reg_state = IB_DEV_UNREGISTERED;
 439 }
 440 EXPORT_SYMBOL(ib_unregister_device);
 441
 442 /**
 443  * ib_register_client - Register an IB client
 444  * @client:Client to register
 445  *
 446  * Upper level users of the IB drivers can use ib_register_client() to
 447  * register callbacks for IB device addition and removal.  When an IB
 448  * device is added, each registered client's add method will be called
 449  * (in the order the clients were registered), and when a device is
 450  * removed, each client's remove method will be called (in the reverse
 451  * order that clients were registered).  In addition, when
 452  * ib_register_client() is called, the client will receive an add
 453  * callback for all devices already registered.
 454  */
 455 int ib_register_client(struct ib_client *client)
 456 {
 457         struct ib_device *device;
 458
 459         mutex_lock(&device_mutex);
 460
 461         list_for_each_entry(device, &device_list, core_list)
 462                 if (client->add && !add_client_context(device, client))
 463                         client->add(device);
 464
 465         down_write(&lists_rwsem);
 466         list_add_tail(&client->list, &client_list);
 467         up_write(&lists_rwsem);
 468
 469         mutex_unlock(&device_mutex);
 470
 471         return 0;
 472 }
 473 EXPORT_SYMBOL(ib_register_client);
 474
 475 /**
 476  * ib_unregister_client - Unregister an IB client
 477  * @client:Client to unregister
 478  *
 479  * Upper level users use ib_unregister_client() to remove their client
 480  * registration.  When ib_unregister_client() is called, the client
 481  * will receive a remove callback for each IB device still registered.
 482  */
 483 void ib_unregister_client(struct ib_client *client)
 484 {
 485         struct ib_client_data *context, *tmp;
 486         struct ib_device *device;
 487         unsigned long flags;
 488
 489         mutex_lock(&device_mutex);
 490
 491         down_write(&lists_rwsem);
 492         list_del(&client->list);
 493         up_write(&lists_rwsem);
 494
 495         list_for_each_entry(device, &device_list, core_list) {
 496                 struct ib_client_data *found_context = NULL;
 497
 498                 down_write(&lists_rwsem);
 499                 spin_lock_irqsave(&device->client_data_lock, flags);
 500                 list_for_each_entry_safe(context, tmp, &device->client_data_list, list)
 501                         if (context->client == client) {
 502                                 context->going_down = true;
 503                                 found_context = context;
 504                                 break;
 505                         }
 506                 spin_unlock_irqrestore(&device->client_data_lock, flags);
 507                 up_write(&lists_rwsem);
 508
 509                 if (client->remove)
 510                         client->remove(device, found_context ?
 511                                                found_context->data : NULL);
 512
 513                 if (!found_context) {
 514                         pr_warn("No client context found for %s/%s\n",
 515                                 device->name, client->name);
 516                         continue;
 517                 }
 518
 519                 down_write(&lists_rwsem);
 520                 spin_lock_irqsave(&device->client_data_lock, flags);
 521                 list_del(&found_context->list);
 522                 kfree(found_context);
 523                 spin_unlock_irqrestore(&device->client_data_lock, flags);
 524                 up_write(&lists_rwsem);
 525         }
 526
 527         mutex_unlock(&device_mutex);
 528 }
 529 EXPORT_SYMBOL(ib_unregister_client);
 530
 531 /**
 532  * ib_get_client_data - Get IB client context
 533  * @device:Device to get context for
 534  * @client:Client to get context for
 535  *
 536  * ib_get_client_data() returns client context set with
 537  * ib_set_client_data().
 538  */
 539 void *ib_get_client_data(struct ib_device *device, struct ib_client *client)
 540 {
 541         struct ib_client_data *context;
 542         void *ret = NULL;
 543         unsigned long flags;
 544
 545         spin_lock_irqsave(&device->client_data_lock, flags);
 546         list_for_each_entry(context, &device->client_data_list, list)
 547                 if (context->client == client) {
 548                         ret = context->data;
 549                         break;
 550                 }
 551         spin_unlock_irqrestore(&device->client_data_lock, flags);
 552
 553         return ret;
 554 }
 555 EXPORT_SYMBOL(ib_get_client_data);
 556
 557 /**
 558  * ib_set_client_data - Set IB client context
 559  * @device:Device to set context for
 560  * @client:Client to set context for
 561  * @data:Context to set
 562  *
 563  * ib_set_client_data() sets client context that can be retrieved with
 564  * ib_get_client_data().
 565  */
 566 void ib_set_client_data(struct ib_device *device, struct ib_client *client,
 567                         void *data)
 568 {
 569         struct ib_client_data *context;
 570         unsigned long flags;
 571
 572         spin_lock_irqsave(&device->client_data_lock, flags);
 573         list_for_each_entry(context, &device->client_data_list, list)
 574                 if (context->client == client) {
 575                         context->data = data;
 576                         goto out;
 577                 }
 578
 579         pr_warn("No client context found for %s/%s\n",
 580                 device->name, client->name);
 581
 582 out:
 583         spin_unlock_irqrestore(&device->client_data_lock, flags);
 584 }
 585 EXPORT_SYMBOL(ib_set_client_data);
 586
 587 /**
 588  * ib_register_event_handler - Register an IB event handler
 589  * @event_handler:Handler to register
 590  *
 591  * ib_register_event_handler() registers an event handler that will be
 592  * called back when asynchronous IB events occur (as defined in
 593  * chapter 11 of the InfiniBand Architecture Specification).  This
 594  * callback may occur in interrupt context.
 595  */
 596 int ib_register_event_handler  (struct ib_event_handler *event_handler)
 597 {
 598         unsigned long flags;
 599
 600         spin_lock_irqsave(&event_handler->device->event_handler_lock, flags);
 601         list_add_tail(&event_handler->list,
 602                       &event_handler->device->event_handler_list);
 603         spin_unlock_irqrestore(&event_handler->device->event_handler_lock, flags);
 604
 605         return 0;
 606 }
 607 EXPORT_SYMBOL(ib_register_event_handler);
 608
 609 /**
 610  * ib_unregister_event_handler - Unregister an event handler
 611  * @event_handler:Handler to unregister
 612  *
 613  * Unregister an event handler registered with
 614  * ib_register_event_handler().
 615  */
 616 int ib_unregister_event_handler(struct ib_event_handler *event_handler)
 617 {
 618         unsigned long flags;
 619
 620         spin_lock_irqsave(&event_handler->device->event_handler_lock, flags);
 621         list_del(&event_handler->list);
 622         spin_unlock_irqrestore(&event_handler->device->event_handler_lock, flags);
 623
 624         return 0;
 625 }
 626 EXPORT_SYMBOL(ib_unregister_event_handler);
 627
 628 /**
 629  * ib_dispatch_event - Dispatch an asynchronous event
 630  * @event:Event to dispatch
 631  *
 632  * Low-level drivers must call ib_dispatch_event() to dispatch the
 633  * event to all registered event handlers when an asynchronous event
 634  * occurs.
 635  */
 636 void ib_dispatch_event(struct ib_event *event)
 637 {
 638         unsigned long flags;
 639         struct ib_event_handler *handler;
 640
 641         spin_lock_irqsave(&event->device->event_handler_lock, flags);
 642
 643         list_for_each_entry(handler, &event->device->event_handler_list, list)
 644                 handler->handler(handler, event);
 645
 646         spin_unlock_irqrestore(&event->device->event_handler_lock, flags);
 647 }
 648 EXPORT_SYMBOL(ib_dispatch_event);
 649
 650 /**
 651  * ib_query_port - Query IB port attributes
 652  * @device:Device to query
 653  * @port_num:Port number to query
 654  * @port_attr:Port attributes
 655  *
 656  * ib_query_port() returns the attributes of a port through the
 657  * @port_attr pointer.
 658  */
 659 int ib_query_port(struct ib_device *device,
 660                   u8 port_num,
 661                   struct ib_port_attr *port_attr)
 662 {
 663         union ib_gid gid;
 664         int err;
 665
 666         if (port_num < rdma_start_port(device) || port_num > rdma_end_port(device))
 667                 return -EINVAL;
 668
 669         memset(port_attr, 0, sizeof(*port_attr));
 670         err = device->query_port(device, port_num, port_attr);
 671         if (err || port_attr->subnet_prefix)
 672                 return err;
 673
 674         if (rdma_port_get_link_layer(device, port_num) != IB_LINK_LAYER_INFINIBAND)
 675                 return 0;
 676
 677         err = ib_query_gid(device, port_num, 0, &gid, NULL);
 678         if (err)
 679                 return err;
 680
 681         port_attr->subnet_prefix = be64_to_cpu(gid.global.subnet_prefix);
 682         return 0;
 683 }
 684 EXPORT_SYMBOL(ib_query_port);
 685
 686 /**
 687  * ib_query_gid - Get GID table entry
 688  * @device:Device to query
 689  * @port_num:Port number to query
 690  * @index:GID table index to query
 691  * @gid:Returned GID
 692  * @attr: Returned GID attributes related to this GID index (only in RoCE).
 693  *   NULL means ignore.
 694  *
 695  * ib_query_gid() fetches the specified GID table entry.
 696  */
 697 int ib_query_gid(struct ib_device *device,
 698                  u8 port_num, int index, union ib_gid *gid,
 699                  struct ib_gid_attr *attr)
 700 {
 701         if (rdma_cap_roce_gid_table(device, port_num))
 702                 return ib_get_cached_gid(device, port_num, index, gid, attr);
 703
 704         if (attr)
 705                 return -EINVAL;
 706
 707         return device->query_gid(device, port_num, index, gid);
 708 }
 709 EXPORT_SYMBOL(ib_query_gid);
 710
 711 /**
 712  * ib_enum_roce_netdev - enumerate all RoCE ports
 713  * @ib_dev : IB device we want to query
 714  * @filter: Should we call the callback?
 715  * @filter_cookie: Cookie passed to filter
 716  * @cb: Callback to call for each found RoCE ports
 717  * @cookie: Cookie passed back to the callback
 718  *
 719  * Enumerates all of the physical RoCE ports of ib_dev
 720  * which are related to netdevice and calls callback() on each
 721  * device for which filter() function returns non zero.
 722  */
 723 void ib_enum_roce_netdev(struct ib_device *ib_dev,
 724                          roce_netdev_filter filter,
 725                          void *filter_cookie,
 726                          roce_netdev_callback cb,
 727                          void *cookie)
 728 {
 729         u8 port;
 730
 731         for (port = rdma_start_port(ib_dev); port <= rdma_end_port(ib_dev);
 732              port++)
 733                 if (rdma_protocol_roce(ib_dev, port)) {
 734                         struct net_device *idev = NULL;
 735
 736                         if (ib_dev->get_netdev)
 737                                 idev = ib_dev->get_netdev(ib_dev, port);
 738
 739                         if (idev &&
 740                             idev->reg_state >= NETREG_UNREGISTERED) {
 741                                 dev_put(idev);
 742                                 idev = NULL;
 743                         }
 744
 745                         if (filter(ib_dev, port, idev, filter_cookie))
 746                                 cb(ib_dev, port, idev, cookie);
 747
 748                         if (idev)
 749                                 dev_put(idev);
 750                 }
 751 }
 752
 753 /**
 754  * ib_enum_all_roce_netdevs - enumerate all RoCE devices
 755  * @filter: Should we call the callback?
 756  * @filter_cookie: Cookie passed to filter
 757  * @cb: Callback to call for each found RoCE ports
 758  * @cookie: Cookie passed back to the callback
 759  *
 760  * Enumerates all RoCE devices' physical ports which are related
 761  * to netdevices and calls callback() on each device for which
 762  * filter() function returns non zero.
 763  */
 764 void ib_enum_all_roce_netdevs(roce_netdev_filter filter,
 765                               void *filter_cookie,
 766                               roce_netdev_callback cb,
 767                               void *cookie)
 768 {
 769         struct ib_device *dev;
 770
 771         down_read(&lists_rwsem);
 772         list_for_each_entry(dev, &device_list, core_list)
 773                 ib_enum_roce_netdev(dev, filter, filter_cookie, cb, cookie);
 774         up_read(&lists_rwsem);
 775 }
 776
 777 /**
 778  * ib_query_pkey - Get P_Key table entry
 779  * @device:Device to query
 780  * @port_num:Port number to query
 781  * @index:P_Key table index to query
 782  * @pkey:Returned P_Key
 783  *
 784  * ib_query_pkey() fetches the specified P_Key table entry.
 785  */
 786 int ib_query_pkey(struct ib_device *device,
 787                   u8 port_num, u16 index, u16 *pkey)
 788 {
 789         return device->query_pkey(device, port_num, index, pkey);
 790 }
 791 EXPORT_SYMBOL(ib_query_pkey);
 792
 793 /**
 794  * ib_modify_device - Change IB device attributes
 795  * @device:Device to modify
 796  * @device_modify_mask:Mask of attributes to change
 797  * @device_modify:New attribute values
 798  *
 799  * ib_modify_device() changes a device's attributes as specified by
 800  * the @device_modify_mask and @device_modify structure.
 801  */
 802 int ib_modify_device(struct ib_device *device,
 803                      int device_modify_mask,
 804                      struct ib_device_modify *device_modify)
 805 {
 806         if (!device->modify_device)
 807                 return -ENOSYS;
 808
 809         return device->modify_device(device, device_modify_mask,
 810                                      device_modify);
 811 }
 812 EXPORT_SYMBOL(ib_modify_device);
 813
 814 /**
 815  * ib_modify_port - Modifies the attributes for the specified port.
 816  * @device: The device to modify.
 817  * @port_num: The number of the port to modify.
 818  * @port_modify_mask: Mask used to specify which attributes of the port
 819  *   to change.
 820  * @port_modify: New attribute values for the port.
 821  *
 822  * ib_modify_port() changes a port's attributes as specified by the
 823  * @port_modify_mask and @port_modify structure.
 824  */
 825 int ib_modify_port(struct ib_device *device,
 826                    u8 port_num, int port_modify_mask,
 827                    struct ib_port_modify *port_modify)
 828 {
 829         if (!device->modify_port)
 830                 return -ENOSYS;
 831
 832         if (port_num < rdma_start_port(device) || port_num > rdma_end_port(device))
 833                 return -EINVAL;
 834
 835         return device->modify_port(device, port_num, port_modify_mask,
 836                                    port_modify);
 837 }
 838 EXPORT_SYMBOL(ib_modify_port);
 839
 840 /**
 841  * ib_find_gid - Returns the port number and GID table index where
 842  *   a specified GID value occurs.
 843  * @device: The device to query.
 844  * @gid: The GID value to search for.
 845  * @gid_type: Type of GID.
 846  * @ndev: The ndev related to the GID to search for.
 847  * @port_num: The port number of the device where the GID value was found.
 848  * @index: The index into the GID table where the GID was found.  This
 849  *   parameter may be NULL.
 850  */
 851 int ib_find_gid(struct ib_device *device, union ib_gid *gid,
 852                 enum ib_gid_type gid_type, struct net_device *ndev,
 853                 u8 *port_num, u16 *index)
 854 {
 855         union ib_gid tmp_gid;
 856         int ret, port, i;
 857
 858         for (port = rdma_start_port(device); port <= rdma_end_port(device); ++port) {
 859                 if (rdma_cap_roce_gid_table(device, port)) {
 860                         if (!ib_find_cached_gid_by_port(device, gid, gid_type, port,
 861                                                         ndev, index)) {
 862                                 *port_num = port;
 863                                 return 0;
 864                         }
 865                 }
 866
 867                 if (gid_type != IB_GID_TYPE_IB)
 868                         continue;
 869
 870                 for (i = 0; i < device->port_immutable[port].gid_tbl_len; ++i) {
 871                         ret = ib_query_gid(device, port, i, &tmp_gid, NULL);
 872                         if (ret)
 873                                 continue;
 874
 875                         if (!memcmp(&tmp_gid, gid, sizeof *gid)) {
 876                                 *port_num = port;
 877                                 if (index)
 878                                         *index = i;
 879                                 return 0;
 880                         }
 881                 }
 882         }
 883
 884         return -ENOENT;
 885 }
 886 EXPORT_SYMBOL(ib_find_gid);
 887
 888 /**
 889  * ib_find_pkey - Returns the PKey table index where a specified
 890  *   PKey value occurs.
 891  * @device: The device to query.
 892  * @port_num: The port number of the device to search for the PKey.
 893  * @pkey: The PKey value to search for.
 894  * @index: The index into the PKey table where the PKey was found.
 895  */
 896 int ib_find_pkey(struct ib_device *device,
 897                  u8 port_num, u16 pkey, u16 *index)
 898 {
 899         int ret, i;
 900         u16 tmp_pkey;
 901         int partial_ix = -1;
 902
 903         for (i = 0; i < device->port_immutable[port_num].pkey_tbl_len; ++i) {
 904                 ret = ib_query_pkey(device, port_num, i, &tmp_pkey);
 905                 if (ret)
 906                         return ret;
 907                 if ((pkey & 0x7fff) == (tmp_pkey & 0x7fff)) {
 908                         /* if there is full-member pkey take it.*/
 909                         if (tmp_pkey & 0x8000) {
 910                                 *index = i;
 911                                 return 0;
 912                         }
 913                         if (partial_ix < 0)
 914                                 partial_ix = i;
 915                 }
 916         }
 917
 918         /*no full-member, if exists take the limited*/
 919         if (partial_ix >= 0) {
 920                 *index = partial_ix;
 921                 return 0;
 922         }
 923         return -ENOENT;
 924 }
 925 EXPORT_SYMBOL(ib_find_pkey);
 926
 927 /**
 928  * ib_get_net_dev_by_params() - Return the appropriate net_dev
 929  * for a received CM request
 930  * @dev:        An RDMA device on which the request has been received.
 931  * @port:       Port number on the RDMA device.
 932  * @pkey:       The Pkey the request came on.
 933  * @gid:        A GID that the net_dev uses to communicate.
 934  * @addr:       Contains the IP address that the request specified as its
 935  *              destination.
 936  */
 937 struct net_device *ib_get_net_dev_by_params(struct ib_device *dev,
 938                                             u8 port,
 939                                             u16 pkey,
 940                                             const union ib_gid *gid,
 941                                             const struct sockaddr *addr)
 942 {
 943         struct net_device *net_dev = NULL;
 944         struct ib_client_data *context;
 945
 946         if (!rdma_protocol_ib(dev, port))
 947                 return NULL;
 948
 949         down_read(&lists_rwsem);
 950
 951         list_for_each_entry(context, &dev->client_data_list, list) {
 952                 struct ib_client *client = context->client;
 953
 954                 if (context->going_down)
 955                         continue;
 956
 957                 if (client->get_net_dev_by_params) {
 958                         net_dev = client->get_net_dev_by_params(dev, port, pkey,
 959                                                                 gid, addr,
 960                                                                 context->data);
 961                         if (net_dev)
 962                                 break;
 963                 }
 964         }
 965
 966         up_read(&lists_rwsem);
 967
 968         return net_dev;
 969 }
 970 EXPORT_SYMBOL(ib_get_net_dev_by_params);
 971
 972 static struct ibnl_client_cbs ibnl_ls_cb_table[] = {
 973         [RDMA_NL_LS_OP_RESOLVE] = {
 974                 .dump = ib_nl_handle_resolve_resp,
 975                 .module = THIS_MODULE },
 976         [RDMA_NL_LS_OP_SET_TIMEOUT] = {
 977                 .dump = ib_nl_handle_set_timeout,
 978                 .module = THIS_MODULE },
 979         [RDMA_NL_LS_OP_IP_RESOLVE] = {
 980                 .dump = ib_nl_handle_ip_res_resp,
 981                 .module = THIS_MODULE },
 982 };
 983
 984 static int ib_add_ibnl_clients(void)
 985 {
 986         return ibnl_add_client(RDMA_NL_LS, ARRAY_SIZE(ibnl_ls_cb_table),
 987                                ibnl_ls_cb_table);
 988 }
 989
 990 static void ib_remove_ibnl_clients(void)
 991 {
 992         ibnl_remove_client(RDMA_NL_LS);
 993 }
 994
 995 static int __init ib_core_init(void)
 996 {
 997         int ret;
 998
 999         ib_wq = alloc_workqueue("infiniband", 0, 0);
1000         if (!ib_wq)
1001                 return -ENOMEM;
1002
1003         ib_comp_wq = alloc_workqueue("ib-comp-wq",
1004                         WQ_HIGHPRI | WQ_MEM_RECLAIM | WQ_SYSFS, 0);
1005         if (!ib_comp_wq) {
1006                 ret = -ENOMEM;
1007                 goto err;
1008         }
1009
1010         ib_comp_unbound_wq =
1011                 alloc_workqueue("ib-comp-unb-wq",
1012                                 WQ_UNBOUND | WQ_HIGHPRI | WQ_MEM_RECLAIM |
1013                                 WQ_SYSFS, WQ_UNBOUND_MAX_ACTIVE);
1014         if (!ib_comp_unbound_wq) {
1015                 ret = -ENOMEM;
1016                 goto err_comp;
1017         }
1018
1019         ret = class_register(&ib_class);
1020         if (ret) {
1021                 pr_warn("Couldn't create InfiniBand device class\n");
1022                 goto err_comp_unbound;
1023         }
1024
1025         ret = ibnl_init();
1026         if (ret) {
1027                 pr_warn("Couldn't init IB netlink interface\n");
1028                 goto err_sysfs;
1029         }
1030
1031         ret = addr_init();
1032         if (ret) {
1033                 pr_warn("Could't init IB address resolution\n");
1034                 goto err_ibnl;
1035         }
1036
1037         ret = ib_mad_init();
1038         if (ret) {
1039                 pr_warn("Couldn't init IB MAD\n");
1040                 goto err_addr;
1041         }
1042
1043         ret = ib_sa_init();
1044         if (ret) {
1045                 pr_warn("Couldn't init SA\n");
1046                 goto err_mad;
1047         }
1048
1049         ret = ib_add_ibnl_clients();
1050         if (ret) {
1051                 pr_warn("Couldn't register ibnl clients\n");
1052                 goto err_sa;
1053         }
1054
1055         ib_cache_setup();
1056
1057         return 0;
1058
1059 err_sa:
1060         ib_sa_cleanup();
1061 err_mad:
1062         ib_mad_cleanup();
1063 err_addr:
1064         addr_cleanup();
1065 err_ibnl:
1066         ibnl_cleanup();
1067 err_sysfs:
1068         class_unregister(&ib_class);
1069 err_comp_unbound:
1070         destroy_workqueue(ib_comp_unbound_wq);
1071 err_comp:
1072         destroy_workqueue(ib_comp_wq);
1073 err:
1074         destroy_workqueue(ib_wq);
1075         return ret;
1076 }
1077
1078 static void __exit ib_core_cleanup(void)
1079 {
1080         ib_cache_cleanup();
1081         ib_remove_ibnl_clients();
1082         ib_sa_cleanup();
1083         ib_mad_cleanup();
1084         addr_cleanup();
1085         ibnl_cleanup();
1086         class_unregister(&ib_class);
1087         destroy_workqueue(ib_comp_unbound_wq);
1088         destroy_workqueue(ib_comp_wq);
1089         /* Make sure that any pending umem accounting work is done. */
1090         destroy_workqueue(ib_wq);
1091 }
1092
1093 module_init(ib_core_init);
1094 module_exit(ib_core_cleanup);