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