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 <rdma/rdma_netlink.h>
  42
  43 #include "core_priv.h"
  44
  45 MODULE_AUTHOR("Roland Dreier");
  46 MODULE_DESCRIPTION("core kernel InfiniBand API");
  47 MODULE_LICENSE("Dual BSD/GPL");
  48
  49 struct ib_client_data {
  50         struct list_head  list;
  51         struct ib_client *client;
  52         void *            data;
  53 };
  54
  55 struct workqueue_struct *ib_wq;
  56 EXPORT_SYMBOL_GPL(ib_wq);
  57
  58 static LIST_HEAD(device_list);
  59 static LIST_HEAD(client_list);
  60
  61 /*
  62  * device_mutex protects access to both device_list and client_list.
  63  * There's no real point to using multiple locks or something fancier
  64  * like an rwsem: we always access both lists, and we're always
  65  * modifying one list or the other list.  In any case this is not a
  66  * hot path so there's no point in trying to optimize.
  67  */
  68 static DEFINE_MUTEX(device_mutex);
  69
  70 static int ib_device_check_mandatory(struct ib_device *device)
  71 {
  72 #define IB_MANDATORY_FUNC(x) { offsetof(struct ib_device, x), #x }
  73         static const struct {
  74                 size_t offset;
  75                 char  *name;
  76         } mandatory_table[] = {
  77                 IB_MANDATORY_FUNC(query_device),
  78                 IB_MANDATORY_FUNC(query_port),
  79                 IB_MANDATORY_FUNC(query_pkey),
  80                 IB_MANDATORY_FUNC(query_gid),
  81                 IB_MANDATORY_FUNC(alloc_pd),
  82                 IB_MANDATORY_FUNC(dealloc_pd),
  83                 IB_MANDATORY_FUNC(create_ah),
  84                 IB_MANDATORY_FUNC(destroy_ah),
  85                 IB_MANDATORY_FUNC(create_qp),
  86                 IB_MANDATORY_FUNC(modify_qp),
  87                 IB_MANDATORY_FUNC(destroy_qp),
  88                 IB_MANDATORY_FUNC(post_send),
  89                 IB_MANDATORY_FUNC(post_recv),
  90                 IB_MANDATORY_FUNC(create_cq),
  91                 IB_MANDATORY_FUNC(destroy_cq),
  92                 IB_MANDATORY_FUNC(poll_cq),
  93                 IB_MANDATORY_FUNC(req_notify_cq),
  94                 IB_MANDATORY_FUNC(get_dma_mr),
  95                 IB_MANDATORY_FUNC(dereg_mr)
  96         };
  97         int i;
  98
  99         for (i = 0; i < ARRAY_SIZE(mandatory_table); ++i) {
 100                 if (!*(void **) ((void *) device + mandatory_table[i].offset)) {
 101                         printk(KERN_WARNING "Device %s is missing mandatory function %s\n",
 102                                device->name, mandatory_table[i].name);
 103                         return -EINVAL;
 104                 }
 105         }
 106
 107         return 0;
 108 }
 109
 110 static struct ib_device *__ib_device_get_by_name(const char *name)
 111 {
 112         struct ib_device *device;
 113
 114         list_for_each_entry(device, &device_list, core_list)
 115                 if (!strncmp(name, device->name, IB_DEVICE_NAME_MAX))
 116                         return device;
 117
 118         return NULL;
 119 }
 120
 121
 122 static int alloc_name(char *name)
 123 {
 124         unsigned long *inuse;
 125         char buf[IB_DEVICE_NAME_MAX];
 126         struct ib_device *device;
 127         int i;
 128
 129         inuse = (unsigned long *) get_zeroed_page(GFP_KERNEL);
 130         if (!inuse)
 131                 return -ENOMEM;
 132
 133         list_for_each_entry(device, &device_list, core_list) {
 134                 if (!sscanf(device->name, name, &i))
 135                         continue;
 136                 if (i < 0 || i >= PAGE_SIZE * 8)
 137                         continue;
 138                 snprintf(buf, sizeof buf, name, i);
 139                 if (!strncmp(buf, device->name, IB_DEVICE_NAME_MAX))
 140                         set_bit(i, inuse);
 141         }
 142
 143         i = find_first_zero_bit(inuse, PAGE_SIZE * 8);
 144         free_page((unsigned long) inuse);
 145         snprintf(buf, sizeof buf, name, i);
 146
 147         if (__ib_device_get_by_name(buf))
 148                 return -ENFILE;
 149
 150         strlcpy(name, buf, IB_DEVICE_NAME_MAX);
 151         return 0;
 152 }
 153
 154 static int start_port(struct ib_device *device)
 155 {
 156         return (device->node_type == RDMA_NODE_IB_SWITCH) ? 0 : 1;
 157 }
 158
 159
 160 static int end_port(struct ib_device *device)
 161 {
 162         return (device->node_type == RDMA_NODE_IB_SWITCH) ?
 163                 0 : device->phys_port_cnt;
 164 }
 165
 166 /**
 167  * ib_alloc_device - allocate an IB device struct
 168  * @size:size of structure to allocate
 169  *
 170  * Low-level drivers should use ib_alloc_device() to allocate &struct
 171  * ib_device.  @size is the size of the structure to be allocated,
 172  * including any private data used by the low-level driver.
 173  * ib_dealloc_device() must be used to free structures allocated with
 174  * ib_alloc_device().
 175  */
 176 struct ib_device *ib_alloc_device(size_t size)
 177 {
 178         BUG_ON(size < sizeof (struct ib_device));
 179
 180         return kzalloc(size, GFP_KERNEL);
 181 }
 182 EXPORT_SYMBOL(ib_alloc_device);
 183
 184 /**
 185  * ib_dealloc_device - free an IB device struct
 186  * @device:structure to free
 187  *
 188  * Free a structure allocated with ib_alloc_device().
 189  */
 190 void ib_dealloc_device(struct ib_device *device)
 191 {
 192         if (device->reg_state == IB_DEV_UNINITIALIZED) {
 193                 kfree(device);
 194                 return;
 195         }
 196
 197         BUG_ON(device->reg_state != IB_DEV_UNREGISTERED);
 198
 199         kobject_put(&device->dev.kobj);
 200 }
 201 EXPORT_SYMBOL(ib_dealloc_device);
 202
 203 static int add_client_context(struct ib_device *device, struct ib_client *client)
 204 {
 205         struct ib_client_data *context;
 206         unsigned long flags;
 207
 208         context = kmalloc(sizeof *context, GFP_KERNEL);
 209         if (!context) {
 210                 printk(KERN_WARNING "Couldn't allocate client context for %s/%s\n",
 211                        device->name, client->name);
 212                 return -ENOMEM;
 213         }
 214
 215         context->client = client;
 216         context->data   = NULL;
 217
 218         spin_lock_irqsave(&device->client_data_lock, flags);
 219         list_add(&context->list, &device->client_data_list);
 220         spin_unlock_irqrestore(&device->client_data_lock, flags);
 221
 222         return 0;
 223 }
 224
 225 static int read_port_table_lengths(struct ib_device *device)
 226 {
 227         struct ib_port_attr *tprops = NULL;
 228         int num_ports, ret = -ENOMEM;
 229         u8 port_index;
 230
 231         tprops = kmalloc(sizeof *tprops, GFP_KERNEL);
 232         if (!tprops)
 233                 goto out;
 234
 235         num_ports = end_port(device) - start_port(device) + 1;
 236
 237         device->pkey_tbl_len = kmalloc(sizeof *device->pkey_tbl_len * num_ports,
 238                                        GFP_KERNEL);
 239         device->gid_tbl_len = kmalloc(sizeof *device->gid_tbl_len * num_ports,
 240                                       GFP_KERNEL);
 241         if (!device->pkey_tbl_len || !device->gid_tbl_len)
 242                 goto err;
 243
 244         for (port_index = 0; port_index < num_ports; ++port_index) {
 245                 ret = ib_query_port(device, port_index + start_port(device),
 246                                         tprops);
 247                 if (ret)
 248                         goto err;
 249                 device->pkey_tbl_len[port_index] = tprops->pkey_tbl_len;
 250                 device->gid_tbl_len[port_index]  = tprops->gid_tbl_len;
 251         }
 252
 253         ret = 0;
 254         goto out;
 255
 256 err:
 257         kfree(device->gid_tbl_len);
 258         kfree(device->pkey_tbl_len);
 259 out:
 260         kfree(tprops);
 261         return ret;
 262 }
 263
 264 /**
 265  * ib_register_device - Register an IB device with IB core
 266  * @device:Device to register
 267  *
 268  * Low-level drivers use ib_register_device() to register their
 269  * devices with the IB core.  All registered clients will receive a
 270  * callback for each device that is added. @device must be allocated
 271  * with ib_alloc_device().
 272  */
 273 int ib_register_device(struct ib_device *device,
 274                        int (*port_callback)(struct ib_device *,
 275                                             u8, struct kobject *))
 276 {
 277         int ret;
 278
 279         mutex_lock(&device_mutex);
 280
 281         if (strchr(device->name, '%')) {
 282                 ret = alloc_name(device->name);
 283                 if (ret)
 284                         goto out;
 285         }
 286
 287         if (ib_device_check_mandatory(device)) {
 288                 ret = -EINVAL;
 289                 goto out;
 290         }
 291
 292         INIT_LIST_HEAD(&device->event_handler_list);
 293         INIT_LIST_HEAD(&device->client_data_list);
 294         spin_lock_init(&device->event_handler_lock);
 295         spin_lock_init(&device->client_data_lock);
 296
 297         ret = read_port_table_lengths(device);
 298         if (ret) {
 299                 printk(KERN_WARNING "Couldn't create table lengths cache for device %s\n",
 300                        device->name);
 301                 goto out;
 302         }
 303
 304         ret = ib_device_register_sysfs(device, port_callback);
 305         if (ret) {
 306                 printk(KERN_WARNING "Couldn't register device %s with driver model\n",
 307                        device->name);
 308                 kfree(device->gid_tbl_len);
 309                 kfree(device->pkey_tbl_len);
 310                 goto out;
 311         }
 312
 313         list_add_tail(&device->core_list, &device_list);
 314
 315         device->reg_state = IB_DEV_REGISTERED;
 316
 317         {
 318                 struct ib_client *client;
 319
 320                 list_for_each_entry(client, &client_list, list)
 321                         if (client->add && !add_client_context(device, client))
 322                                 client->add(device);
 323         }
 324
 325  out:
 326         mutex_unlock(&device_mutex);
 327         return ret;
 328 }
 329 EXPORT_SYMBOL(ib_register_device);
 330
 331 /**
 332  * ib_unregister_device - Unregister an IB device
 333  * @device:Device to unregister
 334  *
 335  * Unregister an IB device.  All clients will receive a remove callback.
 336  */
 337 void ib_unregister_device(struct ib_device *device)
 338 {
 339         struct ib_client *client;
 340         struct ib_client_data *context, *tmp;
 341         unsigned long flags;
 342
 343         mutex_lock(&device_mutex);
 344
 345         list_for_each_entry_reverse(client, &client_list, list)
 346                 if (client->remove)
 347                         client->remove(device);
 348
 349         list_del(&device->core_list);
 350
 351         kfree(device->gid_tbl_len);
 352         kfree(device->pkey_tbl_len);
 353
 354         mutex_unlock(&device_mutex);
 355
 356         ib_device_unregister_sysfs(device);
 357
 358         spin_lock_irqsave(&device->client_data_lock, flags);
 359         list_for_each_entry_safe(context, tmp, &device->client_data_list, list)
 360                 kfree(context);
 361         spin_unlock_irqrestore(&device->client_data_lock, flags);
 362
 363         device->reg_state = IB_DEV_UNREGISTERED;
 364 }
 365 EXPORT_SYMBOL(ib_unregister_device);
 366
 367 /**
 368  * ib_register_client - Register an IB client
 369  * @client:Client to register
 370  *
 371  * Upper level users of the IB drivers can use ib_register_client() to
 372  * register callbacks for IB device addition and removal.  When an IB
 373  * device is added, each registered client's add method will be called
 374  * (in the order the clients were registered), and when a device is
 375  * removed, each client's remove method will be called (in the reverse
 376  * order that clients were registered).  In addition, when
 377  * ib_register_client() is called, the client will receive an add
 378  * callback for all devices already registered.
 379  */
 380 int ib_register_client(struct ib_client *client)
 381 {
 382         struct ib_device *device;
 383
 384         mutex_lock(&device_mutex);
 385
 386         list_add_tail(&client->list, &client_list);
 387         list_for_each_entry(device, &device_list, core_list)
 388                 if (client->add && !add_client_context(device, client))
 389                         client->add(device);
 390
 391         mutex_unlock(&device_mutex);
 392
 393         return 0;
 394 }
 395 EXPORT_SYMBOL(ib_register_client);
 396
 397 /**
 398  * ib_unregister_client - Unregister an IB client
 399  * @client:Client to unregister
 400  *
 401  * Upper level users use ib_unregister_client() to remove their client
 402  * registration.  When ib_unregister_client() is called, the client
 403  * will receive a remove callback for each IB device still registered.
 404  */
 405 void ib_unregister_client(struct ib_client *client)
 406 {
 407         struct ib_client_data *context, *tmp;
 408         struct ib_device *device;
 409         unsigned long flags;
 410
 411         mutex_lock(&device_mutex);
 412
 413         list_for_each_entry(device, &device_list, core_list) {
 414                 if (client->remove)
 415                         client->remove(device);
 416
 417                 spin_lock_irqsave(&device->client_data_lock, flags);
 418                 list_for_each_entry_safe(context, tmp, &device->client_data_list, list)
 419                         if (context->client == client) {
 420                                 list_del(&context->list);
 421                                 kfree(context);
 422                         }
 423                 spin_unlock_irqrestore(&device->client_data_lock, flags);
 424         }
 425         list_del(&client->list);
 426
 427         mutex_unlock(&device_mutex);
 428 }
 429 EXPORT_SYMBOL(ib_unregister_client);
 430
 431 /**
 432  * ib_get_client_data - Get IB client context
 433  * @device:Device to get context for
 434  * @client:Client to get context for
 435  *
 436  * ib_get_client_data() returns client context set with
 437  * ib_set_client_data().
 438  */
 439 void *ib_get_client_data(struct ib_device *device, struct ib_client *client)
 440 {
 441         struct ib_client_data *context;
 442         void *ret = NULL;
 443         unsigned long flags;
 444
 445         spin_lock_irqsave(&device->client_data_lock, flags);
 446         list_for_each_entry(context, &device->client_data_list, list)
 447                 if (context->client == client) {
 448                         ret = context->data;
 449                         break;
 450                 }
 451         spin_unlock_irqrestore(&device->client_data_lock, flags);
 452
 453         return ret;
 454 }
 455 EXPORT_SYMBOL(ib_get_client_data);
 456
 457 /**
 458  * ib_set_client_data - Set IB client context
 459  * @device:Device to set context for
 460  * @client:Client to set context for
 461  * @data:Context to set
 462  *
 463  * ib_set_client_data() sets client context that can be retrieved with
 464  * ib_get_client_data().
 465  */
 466 void ib_set_client_data(struct ib_device *device, struct ib_client *client,
 467                         void *data)
 468 {
 469         struct ib_client_data *context;
 470         unsigned long flags;
 471
 472         spin_lock_irqsave(&device->client_data_lock, flags);
 473         list_for_each_entry(context, &device->client_data_list, list)
 474                 if (context->client == client) {
 475                         context->data = data;
 476                         goto out;
 477                 }
 478
 479         printk(KERN_WARNING "No client context found for %s/%s\n",
 480                device->name, client->name);
 481
 482 out:
 483         spin_unlock_irqrestore(&device->client_data_lock, flags);
 484 }
 485 EXPORT_SYMBOL(ib_set_client_data);
 486
 487 /**
 488  * ib_register_event_handler - Register an IB event handler
 489  * @event_handler:Handler to register
 490  *
 491  * ib_register_event_handler() registers an event handler that will be
 492  * called back when asynchronous IB events occur (as defined in
 493  * chapter 11 of the InfiniBand Architecture Specification).  This
 494  * callback may occur in interrupt context.
 495  */
 496 int ib_register_event_handler  (struct ib_event_handler *event_handler)
 497 {
 498         unsigned long flags;
 499
 500         spin_lock_irqsave(&event_handler->device->event_handler_lock, flags);
 501         list_add_tail(&event_handler->list,
 502                       &event_handler->device->event_handler_list);
 503         spin_unlock_irqrestore(&event_handler->device->event_handler_lock, flags);
 504
 505         return 0;
 506 }
 507 EXPORT_SYMBOL(ib_register_event_handler);
 508
 509 /**
 510  * ib_unregister_event_handler - Unregister an event handler
 511  * @event_handler:Handler to unregister
 512  *
 513  * Unregister an event handler registered with
 514  * ib_register_event_handler().
 515  */
 516 int ib_unregister_event_handler(struct ib_event_handler *event_handler)
 517 {
 518         unsigned long flags;
 519
 520         spin_lock_irqsave(&event_handler->device->event_handler_lock, flags);
 521         list_del(&event_handler->list);
 522         spin_unlock_irqrestore(&event_handler->device->event_handler_lock, flags);
 523
 524         return 0;
 525 }
 526 EXPORT_SYMBOL(ib_unregister_event_handler);
 527
 528 /**
 529  * ib_dispatch_event - Dispatch an asynchronous event
 530  * @event:Event to dispatch
 531  *
 532  * Low-level drivers must call ib_dispatch_event() to dispatch the
 533  * event to all registered event handlers when an asynchronous event
 534  * occurs.
 535  */
 536 void ib_dispatch_event(struct ib_event *event)
 537 {
 538         unsigned long flags;
 539         struct ib_event_handler *handler;
 540
 541         spin_lock_irqsave(&event->device->event_handler_lock, flags);
 542
 543         list_for_each_entry(handler, &event->device->event_handler_list, list)
 544                 handler->handler(handler, event);
 545
 546         spin_unlock_irqrestore(&event->device->event_handler_lock, flags);
 547 }
 548 EXPORT_SYMBOL(ib_dispatch_event);
 549
 550 /**
 551  * ib_query_device - Query IB device attributes
 552  * @device:Device to query
 553  * @device_attr:Device attributes
 554  *
 555  * ib_query_device() returns the attributes of a device through the
 556  * @device_attr pointer.
 557  */
 558 int ib_query_device(struct ib_device *device,
 559                     struct ib_device_attr *device_attr)
 560 {
 561         return device->query_device(device, device_attr);
 562 }
 563 EXPORT_SYMBOL(ib_query_device);
 564
 565 /**
 566  * ib_query_port - Query IB port attributes
 567  * @device:Device to query
 568  * @port_num:Port number to query
 569  * @port_attr:Port attributes
 570  *
 571  * ib_query_port() returns the attributes of a port through the
 572  * @port_attr pointer.
 573  */
 574 int ib_query_port(struct ib_device *device,
 575                   u8 port_num,
 576                   struct ib_port_attr *port_attr)
 577 {
 578         if (port_num < start_port(device) || port_num > end_port(device))
 579                 return -EINVAL;
 580
 581         return device->query_port(device, port_num, port_attr);
 582 }
 583 EXPORT_SYMBOL(ib_query_port);
 584
 585 /**
 586  * ib_query_gid - Get GID table entry
 587  * @device:Device to query
 588  * @port_num:Port number to query
 589  * @index:GID table index to query
 590  * @gid:Returned GID
 591  *
 592  * ib_query_gid() fetches the specified GID table entry.
 593  */
 594 int ib_query_gid(struct ib_device *device,
 595                  u8 port_num, int index, union ib_gid *gid)
 596 {
 597         return device->query_gid(device, port_num, index, gid);
 598 }
 599 EXPORT_SYMBOL(ib_query_gid);
 600
 601 /**
 602  * ib_query_pkey - Get P_Key table entry
 603  * @device:Device to query
 604  * @port_num:Port number to query
 605  * @index:P_Key table index to query
 606  * @pkey:Returned P_Key
 607  *
 608  * ib_query_pkey() fetches the specified P_Key table entry.
 609  */
 610 int ib_query_pkey(struct ib_device *device,
 611                   u8 port_num, u16 index, u16 *pkey)
 612 {
 613         return device->query_pkey(device, port_num, index, pkey);
 614 }
 615 EXPORT_SYMBOL(ib_query_pkey);
 616
 617 /**
 618  * ib_modify_device - Change IB device attributes
 619  * @device:Device to modify
 620  * @device_modify_mask:Mask of attributes to change
 621  * @device_modify:New attribute values
 622  *
 623  * ib_modify_device() changes a device's attributes as specified by
 624  * the @device_modify_mask and @device_modify structure.
 625  */
 626 int ib_modify_device(struct ib_device *device,
 627                      int device_modify_mask,
 628                      struct ib_device_modify *device_modify)
 629 {
 630         if (!device->modify_device)
 631                 return -ENOSYS;
 632
 633         return device->modify_device(device, device_modify_mask,
 634                                      device_modify);
 635 }
 636 EXPORT_SYMBOL(ib_modify_device);
 637
 638 /**
 639  * ib_modify_port - Modifies the attributes for the specified port.
 640  * @device: The device to modify.
 641  * @port_num: The number of the port to modify.
 642  * @port_modify_mask: Mask used to specify which attributes of the port
 643  *   to change.
 644  * @port_modify: New attribute values for the port.
 645  *
 646  * ib_modify_port() changes a port's attributes as specified by the
 647  * @port_modify_mask and @port_modify structure.
 648  */
 649 int ib_modify_port(struct ib_device *device,
 650                    u8 port_num, int port_modify_mask,
 651                    struct ib_port_modify *port_modify)
 652 {
 653         if (!device->modify_port)
 654                 return -ENOSYS;
 655
 656         if (port_num < start_port(device) || port_num > end_port(device))
 657                 return -EINVAL;
 658
 659         return device->modify_port(device, port_num, port_modify_mask,
 660                                    port_modify);
 661 }
 662 EXPORT_SYMBOL(ib_modify_port);
 663
 664 /**
 665  * ib_find_gid - Returns the port number and GID table index where
 666  *   a specified GID value occurs.
 667  * @device: The device to query.
 668  * @gid: The GID value to search for.
 669  * @port_num: The port number of the device where the GID value was found.
 670  * @index: The index into the GID table where the GID was found.  This
 671  *   parameter may be NULL.
 672  */
 673 int ib_find_gid(struct ib_device *device, union ib_gid *gid,
 674                 u8 *port_num, u16 *index)
 675 {
 676         union ib_gid tmp_gid;
 677         int ret, port, i;
 678
 679         for (port = start_port(device); port <= end_port(device); ++port) {
 680                 for (i = 0; i < device->gid_tbl_len[port - start_port(device)]; ++i) {
 681                         ret = ib_query_gid(device, port, i, &tmp_gid);
 682                         if (ret)
 683                                 return ret;
 684                         if (!memcmp(&tmp_gid, gid, sizeof *gid)) {
 685                                 *port_num = port;
 686                                 if (index)
 687                                         *index = i;
 688                                 return 0;
 689                         }
 690                 }
 691         }
 692
 693         return -ENOENT;
 694 }
 695 EXPORT_SYMBOL(ib_find_gid);
 696
 697 /**
 698  * ib_find_pkey - Returns the PKey table index where a specified
 699  *   PKey value occurs.
 700  * @device: The device to query.
 701  * @port_num: The port number of the device to search for the PKey.
 702  * @pkey: The PKey value to search for.
 703  * @index: The index into the PKey table where the PKey was found.
 704  */
 705 int ib_find_pkey(struct ib_device *device,
 706                  u8 port_num, u16 pkey, u16 *index)
 707 {
 708         int ret, i;
 709         u16 tmp_pkey;
 710
 711         for (i = 0; i < device->pkey_tbl_len[port_num - start_port(device)]; ++i) {
 712                 ret = ib_query_pkey(device, port_num, i, &tmp_pkey);
 713                 if (ret)
 714                         return ret;
 715
 716                 if ((pkey & 0x7fff) == (tmp_pkey & 0x7fff)) {
 717                         *index = i;
 718                         return 0;
 719                 }
 720         }
 721
 722         return -ENOENT;
 723 }
 724 EXPORT_SYMBOL(ib_find_pkey);
 725
 726 static int __init ib_core_init(void)
 727 {
 728         int ret;
 729
 730         ib_wq = alloc_workqueue("infiniband", 0, 0);
 731         if (!ib_wq)
 732                 return -ENOMEM;
 733
 734         ret = ib_sysfs_setup();
 735         if (ret) {
 736                 printk(KERN_WARNING "Couldn't create InfiniBand device class\n");
 737                 goto err;
 738         }
 739
 740         ret = ibnl_init();
 741         if (ret) {
 742                 printk(KERN_WARNING "Couldn't init IB netlink interface\n");
 743                 goto err_sysfs;
 744         }
 745
 746         ret = ib_cache_setup();
 747         if (ret) {
 748                 printk(KERN_WARNING "Couldn't set up InfiniBand P_Key/GID cache\n");
 749                 goto err_nl;
 750         }
 751
 752         return 0;
 753
 754 err_nl:
 755         ibnl_cleanup();
 756
 757 err_sysfs:
 758         ib_sysfs_cleanup();
 759
 760 err:
 761         destroy_workqueue(ib_wq);
 762         return ret;
 763 }
 764
 765 static void __exit ib_core_cleanup(void)
 766 {
 767         ib_cache_cleanup();
 768         ibnl_cleanup();
 769         ib_sysfs_cleanup();
 770         /* Make sure that any pending umem accounting work is done. */
 771         destroy_workqueue(ib_wq);
 772 }
 773
 774 module_init(ib_core_init);
 775 module_exit(ib_core_cleanup);