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