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_wq;
  62 EXPORT_SYMBOL_GPL(ib_wq);
  63
  64 /* The device_list and client_list contain devices and clients after their
  65  * registration has completed, and the devices and clients are removed
  66  * during unregistration. */
  67 static LIST_HEAD(device_list);
  68 static LIST_HEAD(client_list);
  69
  70 /*
  71  * device_mutex and lists_rwsem protect access to both device_list and
  72  * client_list.  device_mutex protects writer access by device and client
  73  * registration / de-registration.  lists_rwsem protects reader access to
  74  * these lists.  Iterators of these lists must lock it for read, while updates
  75  * to the lists must be done with a write lock. A special case is when the
  76  * device_mutex is locked. In this case locking the lists for read access is
  77  * not necessary as the device_mutex implies it.
  78  *
  79  * lists_rwsem also protects access to the client data list.
  80  */
  81 static DEFINE_MUTEX(device_mutex);
  82 static DECLARE_RWSEM(lists_rwsem);
  83
  84
  85 static int ib_device_check_mandatory(struct ib_device *device)
  86 {
  87 #define IB_MANDATORY_FUNC(x) { offsetof(struct ib_device, x), #x }
  88         static const struct {
  89                 size_t offset;
  90                 char  *name;
  91         } mandatory_table[] = {
  92                 IB_MANDATORY_FUNC(query_device),
  93                 IB_MANDATORY_FUNC(query_port),
  94                 IB_MANDATORY_FUNC(query_pkey),
  95                 IB_MANDATORY_FUNC(query_gid),
  96                 IB_MANDATORY_FUNC(alloc_pd),
  97                 IB_MANDATORY_FUNC(dealloc_pd),
  98                 IB_MANDATORY_FUNC(create_ah),
  99                 IB_MANDATORY_FUNC(destroy_ah),
 100                 IB_MANDATORY_FUNC(create_qp),
 101                 IB_MANDATORY_FUNC(modify_qp),
 102                 IB_MANDATORY_FUNC(destroy_qp),
 103                 IB_MANDATORY_FUNC(post_send),
 104                 IB_MANDATORY_FUNC(post_recv),
 105                 IB_MANDATORY_FUNC(create_cq),
 106                 IB_MANDATORY_FUNC(destroy_cq),
 107                 IB_MANDATORY_FUNC(poll_cq),
 108                 IB_MANDATORY_FUNC(req_notify_cq),
 109                 IB_MANDATORY_FUNC(get_dma_mr),
 110                 IB_MANDATORY_FUNC(dereg_mr),
 111                 IB_MANDATORY_FUNC(get_port_immutable)
 112         };
 113         int i;
 114
 115         for (i = 0; i < ARRAY_SIZE(mandatory_table); ++i) {
 116                 if (!*(void **) ((void *) device + mandatory_table[i].offset)) {
 117                         printk(KERN_WARNING "Device %s is missing mandatory function %s\n",
 118                                device->name, mandatory_table[i].name);
 119                         return -EINVAL;
 120                 }
 121         }
 122
 123         return 0;
 124 }
 125
 126 static struct ib_device *__ib_device_get_by_name(const char *name)
 127 {
 128         struct ib_device *device;
 129
 130         list_for_each_entry(device, &device_list, core_list)
 131                 if (!strncmp(name, device->name, IB_DEVICE_NAME_MAX))
 132                         return device;
 133
 134         return NULL;
 135 }
 136
 137
 138 static int alloc_name(char *name)
 139 {
 140         unsigned long *inuse;
 141         char buf[IB_DEVICE_NAME_MAX];
 142         struct ib_device *device;
 143         int i;
 144
 145         inuse = (unsigned long *) get_zeroed_page(GFP_KERNEL);
 146         if (!inuse)
 147                 return -ENOMEM;
 148
 149         list_for_each_entry(device, &device_list, core_list) {
 150                 if (!sscanf(device->name, name, &i))
 151                         continue;
 152                 if (i < 0 || i >= PAGE_SIZE * 8)
 153                         continue;
 154                 snprintf(buf, sizeof buf, name, i);
 155                 if (!strncmp(buf, device->name, IB_DEVICE_NAME_MAX))
 156                         set_bit(i, inuse);
 157         }
 158
 159         i = find_first_zero_bit(inuse, PAGE_SIZE * 8);
 160         free_page((unsigned long) inuse);
 161         snprintf(buf, sizeof buf, name, i);
 162
 163         if (__ib_device_get_by_name(buf))
 164                 return -ENFILE;
 165
 166         strlcpy(name, buf, IB_DEVICE_NAME_MAX);
 167         return 0;
 168 }
 169
 170 static void ib_device_release(struct device *device)
 171 {
 172         struct ib_device *dev = container_of(device, struct ib_device, dev);
 173
 174         ib_cache_release_one(dev);
 175         kfree(dev->port_immutable);
 176         kfree(dev);
 177 }
 178
 179 static int ib_device_uevent(struct device *device,
 180                             struct kobj_uevent_env *env)
 181 {
 182         struct ib_device *dev = container_of(device, struct ib_device, dev);
 183
 184         if (add_uevent_var(env, "NAME=%s", dev->name))
 185                 return -ENOMEM;
 186
 187         /*
 188          * It would be nice to pass the node GUID with the event...
 189          */
 190
 191         return 0;
 192 }
 193
 194 static struct class ib_class = {
 195         .name    = "infiniband",
 196         .dev_release = ib_device_release,
 197         .dev_uevent = ib_device_uevent,
 198 };
 199
 200 /**
 201  * ib_alloc_device - allocate an IB device struct
 202  * @size:size of structure to allocate
 203  *
 204  * Low-level drivers should use ib_alloc_device() to allocate &struct
 205  * ib_device.  @size is the size of the structure to be allocated,
 206  * including any private data used by the low-level driver.
 207  * ib_dealloc_device() must be used to free structures allocated with
 208  * ib_alloc_device().
 209  */
 210 struct ib_device *ib_alloc_device(size_t size)
 211 {
 212         struct ib_device *device;
 213
 214         if (WARN_ON(size < sizeof(struct ib_device)))
 215                 return NULL;
 216
 217         device = kzalloc(size, GFP_KERNEL);
 218         if (!device)
 219                 return NULL;
 220
 221         device->dev.class = &ib_class;
 222         device_initialize(&device->dev);
 223
 224         dev_set_drvdata(&device->dev, device);
 225
 226         INIT_LIST_HEAD(&device->event_handler_list);
 227         spin_lock_init(&device->event_handler_lock);
 228         spin_lock_init(&device->client_data_lock);
 229         INIT_LIST_HEAD(&device->client_data_list);
 230         INIT_LIST_HEAD(&device->port_list);
 231
 232         return device;
 233 }
 234 EXPORT_SYMBOL(ib_alloc_device);
 235
 236 /**
 237  * ib_dealloc_device - free an IB device struct
 238  * @device:structure to free
 239  *
 240  * Free a structure allocated with ib_alloc_device().
 241  */
 242 void ib_dealloc_device(struct ib_device *device)
 243 {
 244         WARN_ON(device->reg_state != IB_DEV_UNREGISTERED &&
 245                 device->reg_state != IB_DEV_UNINITIALIZED);
 246         kobject_put(&device->dev.kobj);
 247 }
 248 EXPORT_SYMBOL(ib_dealloc_device);
 249
 250 static int add_client_context(struct ib_device *device, struct ib_client *client)
 251 {
 252         struct ib_client_data *context;
 253         unsigned long flags;
 254
 255         context = kmalloc(sizeof *context, GFP_KERNEL);
 256         if (!context) {
 257                 printk(KERN_WARNING "Couldn't allocate client context for %s/%s\n",
 258                        device->name, client->name);
 259                 return -ENOMEM;
 260         }
 261
 262         context->client = client;
 263         context->data   = NULL;
 264         context->going_down = false;
 265
 266         down_write(&lists_rwsem);
 267         spin_lock_irqsave(&device->client_data_lock, flags);
 268         list_add(&context->list, &device->client_data_list);
 269         spin_unlock_irqrestore(&device->client_data_lock, flags);
 270         up_write(&lists_rwsem);
 271
 272         return 0;
 273 }
 274
 275 static int verify_immutable(const struct ib_device *dev, u8 port)
 276 {
 277         return WARN_ON(!rdma_cap_ib_mad(dev, port) &&
 278                             rdma_max_mad_size(dev, port) != 0);
 279 }
 280
 281 static int read_port_immutable(struct ib_device *device)
 282 {
 283         int ret;
 284         u8 start_port = rdma_start_port(device);
 285         u8 end_port = rdma_end_port(device);
 286         u8 port;
 287
 288         /**
 289          * device->port_immutable is indexed directly by the port number to make
 290          * access to this data as efficient as possible.
 291          *
 292          * Therefore port_immutable is declared as a 1 based array with
 293          * potential empty slots at the beginning.
 294          */
 295         device->port_immutable = kzalloc(sizeof(*device->port_immutable)
 296                                          * (end_port + 1),
 297                                          GFP_KERNEL);
 298         if (!device->port_immutable)
 299                 return -ENOMEM;
 300
 301         for (port = start_port; port <= end_port; ++port) {
 302                 ret = device->get_port_immutable(device, port,
 303                                                  &device->port_immutable[port]);
 304                 if (ret)
 305                         return ret;
 306
 307                 if (verify_immutable(device, port))
 308                         return -EINVAL;
 309         }
 310         return 0;
 311 }
 312
 313 /**
 314  * ib_register_device - Register an IB device with IB core
 315  * @device:Device to register
 316  *
 317  * Low-level drivers use ib_register_device() to register their
 318  * devices with the IB core.  All registered clients will receive a
 319  * callback for each device that is added. @device must be allocated
 320  * with ib_alloc_device().
 321  */
 322 int ib_register_device(struct ib_device *device,
 323                        int (*port_callback)(struct ib_device *,
 324                                             u8, struct kobject *))
 325 {
 326         int ret;
 327         struct ib_client *client;
 328         struct ib_udata uhw = {.outlen = 0, .inlen = 0};
 329
 330         mutex_lock(&device_mutex);
 331
 332         if (strchr(device->name, '%')) {
 333                 ret = alloc_name(device->name);
 334                 if (ret)
 335                         goto out;
 336         }
 337
 338         if (ib_device_check_mandatory(device)) {
 339                 ret = -EINVAL;
 340                 goto out;
 341         }
 342
 343         ret = read_port_immutable(device);
 344         if (ret) {
 345                 printk(KERN_WARNING "Couldn't create per port immutable data %s\n",
 346                        device->name);
 347                 goto out;
 348         }
 349
 350         ret = ib_cache_setup_one(device);
 351         if (ret) {
 352                 printk(KERN_WARNING "Couldn't set up InfiniBand P_Key/GID cache\n");
 353                 goto out;
 354         }
 355
 356         memset(&device->attrs, 0, sizeof(device->attrs));
 357         ret = device->query_device(device, &device->attrs, &uhw);
 358         if (ret) {
 359                 printk(KERN_WARNING "Couldn't query the device attributes\n");
 360                 goto out;
 361         }
 362
 363         ret = ib_device_register_sysfs(device, port_callback);
 364         if (ret) {
 365                 printk(KERN_WARNING "Couldn't register device %s with driver model\n",
 366                        device->name);
 367                 ib_cache_cleanup_one(device);
 368                 goto out;
 369         }
 370
 371         device->reg_state = IB_DEV_REGISTERED;
 372
 373         list_for_each_entry(client, &client_list, list)
 374                 if (client->add && !add_client_context(device, client))
 375                         client->add(device);
 376
 377         down_write(&lists_rwsem);
 378         list_add_tail(&device->core_list, &device_list);
 379         up_write(&lists_rwsem);
 380 out:
 381         mutex_unlock(&device_mutex);
 382         return ret;
 383 }
 384 EXPORT_SYMBOL(ib_register_device);
 385
 386 /**
 387  * ib_unregister_device - Unregister an IB device
 388  * @device:Device to unregister
 389  *
 390  * Unregister an IB device.  All clients will receive a remove callback.
 391  */
 392 void ib_unregister_device(struct ib_device *device)
 393 {
 394         struct ib_client_data *context, *tmp;
 395         unsigned long flags;
 396
 397         mutex_lock(&device_mutex);
 398
 399         down_write(&lists_rwsem);
 400         list_del(&device->core_list);
 401         spin_lock_irqsave(&device->client_data_lock, flags);
 402         list_for_each_entry_safe(context, tmp, &device->client_data_list, list)
 403                 context->going_down = true;
 404         spin_unlock_irqrestore(&device->client_data_lock, flags);
 405         downgrade_write(&lists_rwsem);
 406
 407         list_for_each_entry_safe(context, tmp, &device->client_data_list,
 408                                  list) {
 409                 if (context->client->remove)
 410                         context->client->remove(device, context->data);
 411         }
 412         up_read(&lists_rwsem);
 413
 414         mutex_unlock(&device_mutex);
 415
 416         ib_device_unregister_sysfs(device);
 417         ib_cache_cleanup_one(device);
 418
 419         down_write(&lists_rwsem);
 420         spin_lock_irqsave(&device->client_data_lock, flags);
 421         list_for_each_entry_safe(context, tmp, &device->client_data_list, list)
 422                 kfree(context);
 423         spin_unlock_irqrestore(&device->client_data_lock, flags);
 424         up_write(&lists_rwsem);
 425
 426         device->reg_state = IB_DEV_UNREGISTERED;
 427 }
 428 EXPORT_SYMBOL(ib_unregister_device);
 429
 430 /**
 431  * ib_register_client - Register an IB client
 432  * @client:Client to register
 433  *
 434  * Upper level users of the IB drivers can use ib_register_client() to
 435  * register callbacks for IB device addition and removal.  When an IB
 436  * device is added, each registered client's add method will be called
 437  * (in the order the clients were registered), and when a device is
 438  * removed, each client's remove method will be called (in the reverse
 439  * order that clients were registered).  In addition, when
 440  * ib_register_client() is called, the client will receive an add
 441  * callback for all devices already registered.
 442  */
 443 int ib_register_client(struct ib_client *client)
 444 {
 445         struct ib_device *device;
 446
 447         mutex_lock(&device_mutex);
 448
 449         list_for_each_entry(device, &device_list, core_list)
 450                 if (client->add && !add_client_context(device, client))
 451                         client->add(device);
 452
 453         down_write(&lists_rwsem);
 454         list_add_tail(&client->list, &client_list);
 455         up_write(&lists_rwsem);
 456
 457         mutex_unlock(&device_mutex);
 458
 459         return 0;
 460 }
 461 EXPORT_SYMBOL(ib_register_client);
 462
 463 /**
 464  * ib_unregister_client - Unregister an IB client
 465  * @client:Client to unregister
 466  *
 467  * Upper level users use ib_unregister_client() to remove their client
 468  * registration.  When ib_unregister_client() is called, the client
 469  * will receive a remove callback for each IB device still registered.
 470  */
 471 void ib_unregister_client(struct ib_client *client)
 472 {
 473         struct ib_client_data *context, *tmp;
 474         struct ib_device *device;
 475         unsigned long flags;
 476
 477         mutex_lock(&device_mutex);
 478
 479         down_write(&lists_rwsem);
 480         list_del(&client->list);
 481         up_write(&lists_rwsem);
 482
 483         list_for_each_entry(device, &device_list, core_list) {
 484                 struct ib_client_data *found_context = NULL;
 485
 486                 down_write(&lists_rwsem);
 487                 spin_lock_irqsave(&device->client_data_lock, flags);
 488                 list_for_each_entry_safe(context, tmp, &device->client_data_list, list)
 489                         if (context->client == client) {
 490                                 context->going_down = true;
 491                                 found_context = context;
 492                                 break;
 493                         }
 494                 spin_unlock_irqrestore(&device->client_data_lock, flags);
 495                 up_write(&lists_rwsem);
 496
 497                 if (client->remove)
 498                         client->remove(device, found_context ?
 499                                                found_context->data : NULL);
 500
 501                 if (!found_context) {
 502                         pr_warn("No client context found for %s/%s\n",
 503                                 device->name, client->name);
 504                         continue;
 505                 }
 506
 507                 down_write(&lists_rwsem);
 508                 spin_lock_irqsave(&device->client_data_lock, flags);
 509                 list_del(&found_context->list);
 510                 kfree(found_context);
 511                 spin_unlock_irqrestore(&device->client_data_lock, flags);
 512                 up_write(&lists_rwsem);
 513         }
 514
 515         mutex_unlock(&device_mutex);
 516 }
 517 EXPORT_SYMBOL(ib_unregister_client);
 518
 519 /**
 520  * ib_get_client_data - Get IB client context
 521  * @device:Device to get context for
 522  * @client:Client to get context for
 523  *
 524  * ib_get_client_data() returns client context set with
 525  * ib_set_client_data().
 526  */
 527 void *ib_get_client_data(struct ib_device *device, struct ib_client *client)
 528 {
 529         struct ib_client_data *context;
 530         void *ret = NULL;
 531         unsigned long flags;
 532
 533         spin_lock_irqsave(&device->client_data_lock, flags);
 534         list_for_each_entry(context, &device->client_data_list, list)
 535                 if (context->client == client) {
 536                         ret = context->data;
 537                         break;
 538                 }
 539         spin_unlock_irqrestore(&device->client_data_lock, flags);
 540
 541         return ret;
 542 }
 543 EXPORT_SYMBOL(ib_get_client_data);
 544
 545 /**
 546  * ib_set_client_data - Set IB client context
 547  * @device:Device to set context for
 548  * @client:Client to set context for
 549  * @data:Context to set
 550  *
 551  * ib_set_client_data() sets client context that can be retrieved with
 552  * ib_get_client_data().
 553  */
 554 void ib_set_client_data(struct ib_device *device, struct ib_client *client,
 555                         void *data)
 556 {
 557         struct ib_client_data *context;
 558         unsigned long flags;
 559
 560         spin_lock_irqsave(&device->client_data_lock, flags);
 561         list_for_each_entry(context, &device->client_data_list, list)
 562                 if (context->client == client) {
 563                         context->data = data;
 564                         goto out;
 565                 }
 566
 567         printk(KERN_WARNING "No client context found for %s/%s\n",
 568                device->name, client->name);
 569
 570 out:
 571         spin_unlock_irqrestore(&device->client_data_lock, flags);
 572 }
 573 EXPORT_SYMBOL(ib_set_client_data);
 574
 575 /**
 576  * ib_register_event_handler - Register an IB event handler
 577  * @event_handler:Handler to register
 578  *
 579  * ib_register_event_handler() registers an event handler that will be
 580  * called back when asynchronous IB events occur (as defined in
 581  * chapter 11 of the InfiniBand Architecture Specification).  This
 582  * callback may occur in interrupt context.
 583  */
 584 int ib_register_event_handler  (struct ib_event_handler *event_handler)
 585 {
 586         unsigned long flags;
 587
 588         spin_lock_irqsave(&event_handler->device->event_handler_lock, flags);
 589         list_add_tail(&event_handler->list,
 590                       &event_handler->device->event_handler_list);
 591         spin_unlock_irqrestore(&event_handler->device->event_handler_lock, flags);
 592
 593         return 0;
 594 }
 595 EXPORT_SYMBOL(ib_register_event_handler);
 596
 597 /**
 598  * ib_unregister_event_handler - Unregister an event handler
 599  * @event_handler:Handler to unregister
 600  *
 601  * Unregister an event handler registered with
 602  * ib_register_event_handler().
 603  */
 604 int ib_unregister_event_handler(struct ib_event_handler *event_handler)
 605 {
 606         unsigned long flags;
 607
 608         spin_lock_irqsave(&event_handler->device->event_handler_lock, flags);
 609         list_del(&event_handler->list);
 610         spin_unlock_irqrestore(&event_handler->device->event_handler_lock, flags);
 611
 612         return 0;
 613 }
 614 EXPORT_SYMBOL(ib_unregister_event_handler);
 615
 616 /**
 617  * ib_dispatch_event - Dispatch an asynchronous event
 618  * @event:Event to dispatch
 619  *
 620  * Low-level drivers must call ib_dispatch_event() to dispatch the
 621  * event to all registered event handlers when an asynchronous event
 622  * occurs.
 623  */
 624 void ib_dispatch_event(struct ib_event *event)
 625 {
 626         unsigned long flags;
 627         struct ib_event_handler *handler;
 628
 629         spin_lock_irqsave(&event->device->event_handler_lock, flags);
 630
 631         list_for_each_entry(handler, &event->device->event_handler_list, list)
 632                 handler->handler(handler, event);
 633
 634         spin_unlock_irqrestore(&event->device->event_handler_lock, flags);
 635 }
 636 EXPORT_SYMBOL(ib_dispatch_event);
 637
 638 /**
 639  * ib_query_port - Query IB port attributes
 640  * @device:Device to query
 641  * @port_num:Port number to query
 642  * @port_attr:Port attributes
 643  *
 644  * ib_query_port() returns the attributes of a port through the
 645  * @port_attr pointer.
 646  */
 647 int ib_query_port(struct ib_device *device,
 648                   u8 port_num,
 649                   struct ib_port_attr *port_attr)
 650 {
 651         if (port_num < rdma_start_port(device) || port_num > rdma_end_port(device))
 652                 return -EINVAL;
 653
 654         return device->query_port(device, port_num, port_attr);
 655 }
 656 EXPORT_SYMBOL(ib_query_port);
 657
 658 /**
 659  * ib_query_gid - Get GID table entry
 660  * @device:Device to query
 661  * @port_num:Port number to query
 662  * @index:GID table index to query
 663  * @gid:Returned GID
 664  * @attr: Returned GID attributes related to this GID index (only in RoCE).
 665  *   NULL means ignore.
 666  *
 667  * ib_query_gid() fetches the specified GID table entry.
 668  */
 669 int ib_query_gid(struct ib_device *device,
 670                  u8 port_num, int index, union ib_gid *gid,
 671                  struct ib_gid_attr *attr)
 672 {
 673         if (rdma_cap_roce_gid_table(device, port_num))
 674                 return ib_get_cached_gid(device, port_num, index, gid, attr);
 675
 676         if (attr)
 677                 return -EINVAL;
 678
 679         return device->query_gid(device, port_num, index, gid);
 680 }
 681 EXPORT_SYMBOL(ib_query_gid);
 682
 683 /**
 684  * ib_enum_roce_netdev - enumerate all RoCE ports
 685  * @ib_dev : IB device we want to query
 686  * @filter: Should we call the callback?
 687  * @filter_cookie: Cookie passed to filter
 688  * @cb: Callback to call for each found RoCE ports
 689  * @cookie: Cookie passed back to the callback
 690  *
 691  * Enumerates all of the physical RoCE ports of ib_dev
 692  * which are related to netdevice and calls callback() on each
 693  * device for which filter() function returns non zero.
 694  */
 695 void ib_enum_roce_netdev(struct ib_device *ib_dev,
 696                          roce_netdev_filter filter,
 697                          void *filter_cookie,
 698                          roce_netdev_callback cb,
 699                          void *cookie)
 700 {
 701         u8 port;
 702
 703         for (port = rdma_start_port(ib_dev); port <= rdma_end_port(ib_dev);
 704              port++)
 705                 if (rdma_protocol_roce(ib_dev, port)) {
 706                         struct net_device *idev = NULL;
 707
 708                         if (ib_dev->get_netdev)
 709                                 idev = ib_dev->get_netdev(ib_dev, port);
 710
 711                         if (idev &&
 712                             idev->reg_state >= NETREG_UNREGISTERED) {
 713                                 dev_put(idev);
 714                                 idev = NULL;
 715                         }
 716
 717                         if (filter(ib_dev, port, idev, filter_cookie))
 718                                 cb(ib_dev, port, idev, cookie);
 719
 720                         if (idev)
 721                                 dev_put(idev);
 722                 }
 723 }
 724
 725 /**
 726  * ib_enum_all_roce_netdevs - enumerate all RoCE devices
 727  * @filter: Should we call the callback?
 728  * @filter_cookie: Cookie passed to filter
 729  * @cb: Callback to call for each found RoCE ports
 730  * @cookie: Cookie passed back to the callback
 731  *
 732  * Enumerates all RoCE devices' physical ports which are related
 733  * to netdevices and calls callback() on each device for which
 734  * filter() function returns non zero.
 735  */
 736 void ib_enum_all_roce_netdevs(roce_netdev_filter filter,
 737                               void *filter_cookie,
 738                               roce_netdev_callback cb,
 739                               void *cookie)
 740 {
 741         struct ib_device *dev;
 742
 743         down_read(&lists_rwsem);
 744         list_for_each_entry(dev, &device_list, core_list)
 745                 ib_enum_roce_netdev(dev, filter, filter_cookie, cb, cookie);
 746         up_read(&lists_rwsem);
 747 }
 748
 749 /**
 750  * ib_query_pkey - Get P_Key table entry
 751  * @device:Device to query
 752  * @port_num:Port number to query
 753  * @index:P_Key table index to query
 754  * @pkey:Returned P_Key
 755  *
 756  * ib_query_pkey() fetches the specified P_Key table entry.
 757  */
 758 int ib_query_pkey(struct ib_device *device,
 759                   u8 port_num, u16 index, u16 *pkey)
 760 {
 761         return device->query_pkey(device, port_num, index, pkey);
 762 }
 763 EXPORT_SYMBOL(ib_query_pkey);
 764
 765 /**
 766  * ib_modify_device - Change IB device attributes
 767  * @device:Device to modify
 768  * @device_modify_mask:Mask of attributes to change
 769  * @device_modify:New attribute values
 770  *
 771  * ib_modify_device() changes a device's attributes as specified by
 772  * the @device_modify_mask and @device_modify structure.
 773  */
 774 int ib_modify_device(struct ib_device *device,
 775                      int device_modify_mask,
 776                      struct ib_device_modify *device_modify)
 777 {
 778         if (!device->modify_device)
 779                 return -ENOSYS;
 780
 781         return device->modify_device(device, device_modify_mask,
 782                                      device_modify);
 783 }
 784 EXPORT_SYMBOL(ib_modify_device);
 785
 786 /**
 787  * ib_modify_port - Modifies the attributes for the specified port.
 788  * @device: The device to modify.
 789  * @port_num: The number of the port to modify.
 790  * @port_modify_mask: Mask used to specify which attributes of the port
 791  *   to change.
 792  * @port_modify: New attribute values for the port.
 793  *
 794  * ib_modify_port() changes a port's attributes as specified by the
 795  * @port_modify_mask and @port_modify structure.
 796  */
 797 int ib_modify_port(struct ib_device *device,
 798                    u8 port_num, int port_modify_mask,
 799                    struct ib_port_modify *port_modify)
 800 {
 801         if (!device->modify_port)
 802                 return -ENOSYS;
 803
 804         if (port_num < rdma_start_port(device) || port_num > rdma_end_port(device))
 805                 return -EINVAL;
 806
 807         return device->modify_port(device, port_num, port_modify_mask,
 808                                    port_modify);
 809 }
 810 EXPORT_SYMBOL(ib_modify_port);
 811
 812 /**
 813  * ib_find_gid - Returns the port number and GID table index where
 814  *   a specified GID value occurs.
 815  * @device: The device to query.
 816  * @gid: The GID value to search for.
 817  * @ndev: The ndev related to the GID to search for.
 818  * @port_num: The port number of the device where the GID value was found.
 819  * @index: The index into the GID table where the GID was found.  This
 820  *   parameter may be NULL.
 821  */
 822 int ib_find_gid(struct ib_device *device, union ib_gid *gid,
 823                 struct net_device *ndev, u8 *port_num, u16 *index)
 824 {
 825         union ib_gid tmp_gid;
 826         int ret, port, i;
 827
 828         for (port = rdma_start_port(device); port <= rdma_end_port(device); ++port) {
 829                 if (rdma_cap_roce_gid_table(device, port)) {
 830                         if (!ib_find_cached_gid_by_port(device, gid, port,
 831                                                         ndev, index)) {
 832                                 *port_num = port;
 833                                 return 0;
 834                         }
 835                 }
 836
 837                 for (i = 0; i < device->port_immutable[port].gid_tbl_len; ++i) {
 838                         ret = ib_query_gid(device, port, i, &tmp_gid, NULL);
 839                         if (ret)
 840                                 return ret;
 841                         if (!memcmp(&tmp_gid, gid, sizeof *gid)) {
 842                                 *port_num = port;
 843                                 if (index)
 844                                         *index = i;
 845                                 return 0;
 846                         }
 847                 }
 848         }
 849
 850         return -ENOENT;
 851 }
 852 EXPORT_SYMBOL(ib_find_gid);
 853
 854 /**
 855  * ib_find_pkey - Returns the PKey table index where a specified
 856  *   PKey value occurs.
 857  * @device: The device to query.
 858  * @port_num: The port number of the device to search for the PKey.
 859  * @pkey: The PKey value to search for.
 860  * @index: The index into the PKey table where the PKey was found.
 861  */
 862 int ib_find_pkey(struct ib_device *device,
 863                  u8 port_num, u16 pkey, u16 *index)
 864 {
 865         int ret, i;
 866         u16 tmp_pkey;
 867         int partial_ix = -1;
 868
 869         for (i = 0; i < device->port_immutable[port_num].pkey_tbl_len; ++i) {
 870                 ret = ib_query_pkey(device, port_num, i, &tmp_pkey);
 871                 if (ret)
 872                         return ret;
 873                 if ((pkey & 0x7fff) == (tmp_pkey & 0x7fff)) {
 874                         /* if there is full-member pkey take it.*/
 875                         if (tmp_pkey & 0x8000) {
 876                                 *index = i;
 877                                 return 0;
 878                         }
 879                         if (partial_ix < 0)
 880                                 partial_ix = i;
 881                 }
 882         }
 883
 884         /*no full-member, if exists take the limited*/
 885         if (partial_ix >= 0) {
 886                 *index = partial_ix;
 887                 return 0;
 888         }
 889         return -ENOENT;
 890 }
 891 EXPORT_SYMBOL(ib_find_pkey);
 892
 893 /**
 894  * ib_get_net_dev_by_params() - Return the appropriate net_dev
 895  * for a received CM request
 896  * @dev:        An RDMA device on which the request has been received.
 897  * @port:       Port number on the RDMA device.
 898  * @pkey:       The Pkey the request came on.
 899  * @gid:        A GID that the net_dev uses to communicate.
 900  * @addr:       Contains the IP address that the request specified as its
 901  *              destination.
 902  */
 903 struct net_device *ib_get_net_dev_by_params(struct ib_device *dev,
 904                                             u8 port,
 905                                             u16 pkey,
 906                                             const union ib_gid *gid,
 907                                             const struct sockaddr *addr)
 908 {
 909         struct net_device *net_dev = NULL;
 910         struct ib_client_data *context;
 911
 912         if (!rdma_protocol_ib(dev, port))
 913                 return NULL;
 914
 915         down_read(&lists_rwsem);
 916
 917         list_for_each_entry(context, &dev->client_data_list, list) {
 918                 struct ib_client *client = context->client;
 919
 920                 if (context->going_down)
 921                         continue;
 922
 923                 if (client->get_net_dev_by_params) {
 924                         net_dev = client->get_net_dev_by_params(dev, port, pkey,
 925                                                                 gid, addr,
 926                                                                 context->data);
 927                         if (net_dev)
 928                                 break;
 929                 }
 930         }
 931
 932         up_read(&lists_rwsem);
 933
 934         return net_dev;
 935 }
 936 EXPORT_SYMBOL(ib_get_net_dev_by_params);
 937
 938 static int __init ib_core_init(void)
 939 {
 940         int ret;
 941
 942         ib_wq = alloc_workqueue("infiniband", 0, 0);
 943         if (!ib_wq)
 944                 return -ENOMEM;
 945
 946         ret = class_register(&ib_class);
 947         if (ret) {
 948                 printk(KERN_WARNING "Couldn't create InfiniBand device class\n");
 949                 goto err;
 950         }
 951
 952         ret = ibnl_init();
 953         if (ret) {
 954                 printk(KERN_WARNING "Couldn't init IB netlink interface\n");
 955                 goto err_sysfs;
 956         }
 957
 958         ib_cache_setup();
 959
 960         return 0;
 961
 962 err_sysfs:
 963         class_unregister(&ib_class);
 964
 965 err:
 966         destroy_workqueue(ib_wq);
 967         return ret;
 968 }
 969
 970 static void __exit ib_core_cleanup(void)
 971 {
 972         ib_cache_cleanup();
 973         ibnl_cleanup();
 974         class_unregister(&ib_class);
 975         /* Make sure that any pending umem accounting work is done. */
 976         destroy_workqueue(ib_wq);
 977 }
 978
 979 module_init(ib_core_init);
 980 module_exit(ib_core_cleanup);