[net-next-2.6.git] / drivers / infiniband / core / cache.c

/*
 * Copyright (c) 2004 Topspin Communications.  All rights reserved.
 * Copyright (c) 2005 Intel Corporation. All rights reserved.
 * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved.
 * Copyright (c) 2005 Voltaire, Inc. All rights reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the
 * OpenIB.org BSD license below:
 *
 *     Redistribution and use in source and binary forms, with or
 *     without modification, are permitted provided that the following
 *     conditions are met:
 *
 *      - Redistributions of source code must retain the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer.
 *
 *      - Redistributions in binary form must reproduce the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer in the documentation and/or other materials
 *        provided with the distribution.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 *
 * $Id: cache.c 1349 2004-12-16 21:09:43Z roland $
 */

#include <linux/module.h>
#include <linux/errno.h>
#include <linux/slab.h>
#include <linux/sched.h>	/* INIT_WORK, schedule_work(), flush_scheduled_work() */

#include <rdma/ib_cache.h>

#include "core_priv.h"

struct ib_pkey_cache {
	int             table_len;
	u16             table[0];
};

struct ib_gid_cache {
	int             table_len;
	union ib_gid    table[0];
};

struct ib_update_work {
	struct work_struct work;
	struct ib_device  *device;
	u8                 port_num;
};

static inline int start_port(struct ib_device *device)
{
	return (device->node_type == RDMA_NODE_IB_SWITCH) ? 0 : 1;
}

static inline int end_port(struct ib_device *device)
{
	return (device->node_type == RDMA_NODE_IB_SWITCH) ?
		0 : device->phys_port_cnt;
}

int ib_get_cached_gid(struct ib_device *device,
		      u8                port_num,
		      int               index,
		      union ib_gid     *gid)
{
	struct ib_gid_cache *cache;
	unsigned long flags;
	int ret = 0;

	if (port_num < start_port(device) || port_num > end_port(device))
		return -EINVAL;

	read_lock_irqsave(&device->cache.lock, flags);

	cache = device->cache.gid_cache[port_num - start_port(device)];

	if (index < 0 || index >= cache->table_len)
		ret = -EINVAL;
	else
		*gid = cache->table[index];

	read_unlock_irqrestore(&device->cache.lock, flags);

	return ret;
}
EXPORT_SYMBOL(ib_get_cached_gid);

int ib_find_cached_gid(struct ib_device *device,
		       union ib_gid	*gid,
		       u8               *port_num,
		       u16              *index)
{
	struct ib_gid_cache *cache;
	unsigned long flags;
	int p, i;
	int ret = -ENOENT;

	*port_num = -1;
	if (index)
		*index = -1;

	read_lock_irqsave(&device->cache.lock, flags);

	for (p = 0; p <= end_port(device) - start_port(device); ++p) {
		cache = device->cache.gid_cache[p];
		for (i = 0; i < cache->table_len; ++i) {
			if (!memcmp(gid, &cache->table[i], sizeof *gid)) {
				*port_num = p + start_port(device);
				if (index)
					*index = i;
				ret = 0;
				goto found;
			}
		}
	}
found:
	read_unlock_irqrestore(&device->cache.lock, flags);

	return ret;
}
EXPORT_SYMBOL(ib_find_cached_gid);

int ib_get_cached_pkey(struct ib_device *device,
		       u8                port_num,
		       int               index,
		       u16              *pkey)
{
	struct ib_pkey_cache *cache;
	unsigned long flags;
	int ret = 0;

	if (port_num < start_port(device) || port_num > end_port(device))
		return -EINVAL;

	read_lock_irqsave(&device->cache.lock, flags);

	cache = device->cache.pkey_cache[port_num - start_port(device)];

	if (index < 0 || index >= cache->table_len)
		ret = -EINVAL;
	else
		*pkey = cache->table[index];

	read_unlock_irqrestore(&device->cache.lock, flags);

	return ret;
}
EXPORT_SYMBOL(ib_get_cached_pkey);

int ib_find_cached_pkey(struct ib_device *device,
			u8                port_num,
			u16               pkey,
			u16              *index)
{
	struct ib_pkey_cache *cache;
	unsigned long flags;
	int i;
	int ret = -ENOENT;

	if (port_num < start_port(device) || port_num > end_port(device))
		return -EINVAL;

	read_lock_irqsave(&device->cache.lock, flags);

	cache = device->cache.pkey_cache[port_num - start_port(device)];

	*index = -1;

	for (i = 0; i < cache->table_len; ++i)
		if ((cache->table[i] & 0x7fff) == (pkey & 0x7fff)) {
			*index = i;
			ret = 0;
			break;
		}

	read_unlock_irqrestore(&device->cache.lock, flags);

	return ret;
}
EXPORT_SYMBOL(ib_find_cached_pkey);

int ib_get_cached_lmc(struct ib_device *device,
		      u8                port_num,
		      u8                *lmc)
{
	unsigned long flags;
	int ret = 0;

	if (port_num < start_port(device) || port_num > end_port(device))
		return -EINVAL;

	read_lock_irqsave(&device->cache.lock, flags);
	*lmc = device->cache.lmc_cache[port_num - start_port(device)];
	read_unlock_irqrestore(&device->cache.lock, flags);

	return ret;
}
EXPORT_SYMBOL(ib_get_cached_lmc);

static void ib_cache_update(struct ib_device *device,
			    u8                port)
{
	struct ib_port_attr       *tprops = NULL;
	struct ib_pkey_cache      *pkey_cache = NULL, *old_pkey_cache;
	struct ib_gid_cache       *gid_cache = NULL, *old_gid_cache;
	int                        i;
	int                        ret;

	tprops = kmalloc(sizeof *tprops, GFP_KERNEL);
	if (!tprops)
		return;

	ret = ib_query_port(device, port, tprops);
	if (ret) {
		printk(KERN_WARNING "ib_query_port failed (%d) for %s\n",
		       ret, device->name);
		goto err;
	}

	pkey_cache = kmalloc(sizeof *pkey_cache + tprops->pkey_tbl_len *
			     sizeof *pkey_cache->table, GFP_KERNEL);
	if (!pkey_cache)
		goto err;

	pkey_cache->table_len = tprops->pkey_tbl_len;

	gid_cache = kmalloc(sizeof *gid_cache + tprops->gid_tbl_len *
			    sizeof *gid_cache->table, GFP_KERNEL);
	if (!gid_cache)
		goto err;

	gid_cache->table_len = tprops->gid_tbl_len;

	for (i = 0; i < pkey_cache->table_len; ++i) {
		ret = ib_query_pkey(device, port, i, pkey_cache->table + i);
		if (ret) {
			printk(KERN_WARNING "ib_query_pkey failed (%d) for %s (index %d)\n",
			       ret, device->name, i);
			goto err;
		}
	}

	for (i = 0; i < gid_cache->table_len; ++i) {
		ret = ib_query_gid(device, port, i, gid_cache->table + i);
		if (ret) {
			printk(KERN_WARNING "ib_query_gid failed (%d) for %s (index %d)\n",
			       ret, device->name, i);
			goto err;
		}
	}

	write_lock_irq(&device->cache.lock);

	old_pkey_cache = device->cache.pkey_cache[port - start_port(device)];
	old_gid_cache  = device->cache.gid_cache [port - start_port(device)];

	device->cache.pkey_cache[port - start_port(device)] = pkey_cache;
	device->cache.gid_cache [port - start_port(device)] = gid_cache;

	device->cache.lmc_cache[port - start_port(device)] = tprops->lmc;

	write_unlock_irq(&device->cache.lock);

	kfree(old_pkey_cache);
	kfree(old_gid_cache);
	kfree(tprops);
	return;

err:
	kfree(pkey_cache);
	kfree(gid_cache);
	kfree(tprops);
}

static void ib_cache_task(void *work_ptr)
{
	struct ib_update_work *work = work_ptr;

	ib_cache_update(work->device, work->port_num);
	kfree(work);
}

static void ib_cache_event(struct ib_event_handler *handler,
			   struct ib_event *event)
{
	struct ib_update_work *work;

	if (event->event == IB_EVENT_PORT_ERR    ||
	    event->event == IB_EVENT_PORT_ACTIVE ||
	    event->event == IB_EVENT_LID_CHANGE  ||
	    event->event == IB_EVENT_PKEY_CHANGE ||
	    event->event == IB_EVENT_SM_CHANGE   ||
	    event->event == IB_EVENT_CLIENT_REREGISTER) {
		work = kmalloc(sizeof *work, GFP_ATOMIC);
		if (work) {
			INIT_WORK(&work->work, ib_cache_task, work);
			work->device   = event->device;
			work->port_num = event->element.port_num;
			schedule_work(&work->work);
		}
	}
}

static void ib_cache_setup_one(struct ib_device *device)
{
	int p;

	rwlock_init(&device->cache.lock);

	device->cache.pkey_cache =
		kmalloc(sizeof *device->cache.pkey_cache *
			(end_port(device) - start_port(device) + 1), GFP_KERNEL);
	device->cache.gid_cache =
		kmalloc(sizeof *device->cache.gid_cache *
			(end_port(device) - start_port(device) + 1), GFP_KERNEL);

	device->cache.lmc_cache = kmalloc(sizeof *device->cache.lmc_cache *
					  (end_port(device) -
					   start_port(device) + 1),
					  GFP_KERNEL);

	if (!device->cache.pkey_cache || !device->cache.gid_cache ||
	    !device->cache.lmc_cache) {
		printk(KERN_WARNING "Couldn't allocate cache "
		       "for %s\n", device->name);
		goto err;
	}

	for (p = 0; p <= end_port(device) - start_port(device); ++p) {
		device->cache.pkey_cache[p] = NULL;
		device->cache.gid_cache [p] = NULL;
		ib_cache_update(device, p + start_port(device));
	}

	INIT_IB_EVENT_HANDLER(&device->cache.event_handler,
			      device, ib_cache_event);
	if (ib_register_event_handler(&device->cache.event_handler))
		goto err_cache;

	return;

err_cache:
	for (p = 0; p <= end_port(device) - start_port(device); ++p) {
		kfree(device->cache.pkey_cache[p]);
		kfree(device->cache.gid_cache[p]);
	}

err:
	kfree(device->cache.pkey_cache);
	kfree(device->cache.gid_cache);
	kfree(device->cache.lmc_cache);
}

static void ib_cache_cleanup_one(struct ib_device *device)
{
	int p;

	ib_unregister_event_handler(&device->cache.event_handler);
	flush_scheduled_work();

	for (p = 0; p <= end_port(device) - start_port(device); ++p) {
		kfree(device->cache.pkey_cache[p]);
		kfree(device->cache.gid_cache[p]);
	}

	kfree(device->cache.pkey_cache);
	kfree(device->cache.gid_cache);
	kfree(device->cache.lmc_cache);
}

static struct ib_client cache_client = {
	.name   = "cache",
	.add    = ib_cache_setup_one,
	.remove = ib_cache_cleanup_one
};

int __init ib_cache_setup(void)
{
	return ib_register_client(&cache_client);
}

void __exit ib_cache_cleanup(void)
{
	ib_unregister_client(&cache_client);
}
Commit	Line	Data
1da177e4 LT	1	/*
1da177e4 LT	2	* Copyright (c) 2004 Topspin Communications. All rights reserved.
2a1d9b7f RD	3	* Copyright (c) 2005 Intel Corporation. All rights reserved.
	4	* Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved.
	5	* Copyright (c) 2005 Voltaire, Inc. All rights reserved.
1da177e4 LT	6	*
	7	* This software is available to you under a choice of one of two
	8	* licenses. You may choose to be licensed under the terms of the GNU
	9	* General Public License (GPL) Version 2, available from the file
	10	* COPYING in the main directory of this source tree, or the
	11	* OpenIB.org BSD license below:
	12	*
	13	* Redistribution and use in source and binary forms, with or
	14	* without modification, are permitted provided that the following
	15	* conditions are met:
	16	*
	17	* - Redistributions of source code must retain the above
	18	* copyright notice, this list of conditions and the following
	19	* disclaimer.
	20	*
	21	* - Redistributions in binary form must reproduce the above
	22	* copyright notice, this list of conditions and the following
	23	* disclaimer in the documentation and/or other materials
	24	* provided with the distribution.
	25	*
	26	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
	27	* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
	28	* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
	29	* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
	30	* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
	31	* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
	32	* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
	33	* SOFTWARE.
	34	*
	35	* $Id: cache.c 1349 2004-12-16 21:09:43Z roland $
	36	*/
	37
1da177e4 LT	38	#include <linux/module.h>
	39	#include <linux/errno.h>
	40	#include <linux/slab.h>
4e57b681	41	#include <linux/sched.h> /* INIT_WORK, schedule_work(), flush_scheduled_work() */
1da177e4	42
a4d61e84	43	#include <rdma/ib_cache.h>
1da177e4 LT	44
	45	#include "core_priv.h"
	46
	47	struct ib_pkey_cache {
	48	int table_len;
	49	u16 table[0];
	50	};
	51
	52	struct ib_gid_cache {
	53	int table_len;
	54	union ib_gid table[0];
	55	};
	56
	57	struct ib_update_work {
	58	struct work_struct work;
	59	struct ib_device *device;
	60	u8 port_num;
	61	};
	62
	63	static inline int start_port(struct ib_device *device)
	64	{
07ebafba	65	return (device->node_type == RDMA_NODE_IB_SWITCH) ? 0 : 1;
1da177e4 LT	66	}
	67
	68	static inline int end_port(struct ib_device *device)
	69	{
07ebafba TT	70	return (device->node_type == RDMA_NODE_IB_SWITCH) ?
07ebafba TT	71	0 : device->phys_port_cnt;
1da177e4 LT	72	}
	73
	74	int ib_get_cached_gid(struct ib_device *device,
	75	u8 port_num,
	76	int index,
	77	union ib_gid *gid)
	78	{
	79	struct ib_gid_cache *cache;
	80	unsigned long flags;
	81	int ret = 0;
	82
	83	if (port_num < start_port(device) \|\| port_num > end_port(device))
	84	return -EINVAL;
	85
	86	read_lock_irqsave(&device->cache.lock, flags);
	87
	88	cache = device->cache.gid_cache[port_num - start_port(device)];
	89
	90	if (index < 0 \|\| index >= cache->table_len)
	91	ret = -EINVAL;
	92	else
	93	*gid = cache->table[index];
	94
	95	read_unlock_irqrestore(&device->cache.lock, flags);
	96
	97	return ret;
	98	}
	99	EXPORT_SYMBOL(ib_get_cached_gid);
	100
	101	int ib_find_cached_gid(struct ib_device *device,
	102	union ib_gid *gid,
	103	u8 *port_num,
	104	u16 *index)
	105	{
	106	struct ib_gid_cache *cache;
	107	unsigned long flags;
	108	int p, i;
	109	int ret = -ENOENT;
	110
	111	*port_num = -1;
	112	if (index)
	113	*index = -1;
	114
	115	read_lock_irqsave(&device->cache.lock, flags);
	116
	117	for (p = 0; p <= end_port(device) - start_port(device); ++p) {
	118	cache = device->cache.gid_cache[p];
	119	for (i = 0; i < cache->table_len; ++i) {
	120	if (!memcmp(gid, &cache->table[i], sizeof *gid)) {
	121	*port_num = p + start_port(device);
	122	if (index)
	123	*index = i;
	124	ret = 0;
	125	goto found;
	126	}
	127	}
	128	}
	129	found:
	130	read_unlock_irqrestore(&device->cache.lock, flags);
	131
	132	return ret;
	133	}
	134	EXPORT_SYMBOL(ib_find_cached_gid);
	135
136	int ib_get_cached_pkey(struct ib_device *device,
137	u8 port_num,
138	int index,
139	u16 *pkey)
140	{
141	struct ib_pkey_cache *cache;
142	unsigned long flags;
143	int ret = 0;
144
145	if (port_num < start_port(device) \|\| port_num > end_port(device))
146	return -EINVAL;
147
148	read_lock_irqsave(&device->cache.lock, flags);
149
150	cache = device->cache.pkey_cache[port_num - start_port(device)];
151
152	if (index < 0 \|\| index >= cache->table_len)
153	ret = -EINVAL;
154	else
155	*pkey = cache->table[index];
156
157	read_unlock_irqrestore(&device->cache.lock, flags);
158
159	return ret;
160	}
161	EXPORT_SYMBOL(ib_get_cached_pkey);
162
163	int ib_find_cached_pkey(struct ib_device *device,
164	u8 port_num,
165	u16 pkey,
166	u16 *index)
167	{
168	struct ib_pkey_cache *cache;
169	unsigned long flags;
170	int i;
171	int ret = -ENOENT;
172
173	if (port_num < start_port(device) \|\| port_num > end_port(device))
174	return -EINVAL;
175
176	read_lock_irqsave(&device->cache.lock, flags);
177
178	cache = device->cache.pkey_cache[port_num - start_port(device)];
179
180	*index = -1;
181
182	for (i = 0; i < cache->table_len; ++i)
183	if ((cache->table[i] & 0x7fff) == (pkey & 0x7fff)) {
184	*index = i;
185	ret = 0;
186	break;
187	}
188
189	read_unlock_irqrestore(&device->cache.lock, flags);
190
191	return ret;
192	}
193	EXPORT_SYMBOL(ib_find_cached_pkey);
194
6fb9cdbf JM	195	int ib_get_cached_lmc(struct ib_device *device,
	196	u8 port_num,
	197	u8 *lmc)
	198	{
	199	unsigned long flags;
	200	int ret = 0;
	201
	202	if (port_num < start_port(device) \|\| port_num > end_port(device))
	203	return -EINVAL;
	204
	205	read_lock_irqsave(&device->cache.lock, flags);
	206	*lmc = device->cache.lmc_cache[port_num - start_port(device)];
	207	read_unlock_irqrestore(&device->cache.lock, flags);
	208
	209	return ret;
	210	}
	211	EXPORT_SYMBOL(ib_get_cached_lmc);
	212
1da177e4 LT	213	static void ib_cache_update(struct ib_device *device,
	214	u8 port)
	215	{
	216	struct ib_port_attr *tprops = NULL;
	217	struct ib_pkey_cache pkey_cache = NULL, old_pkey_cache;
	218	struct ib_gid_cache gid_cache = NULL, old_gid_cache;
	219	int i;
	220	int ret;
	221
	222	tprops = kmalloc(sizeof *tprops, GFP_KERNEL);
	223	if (!tprops)
	224	return;
	225
	226	ret = ib_query_port(device, port, tprops);
	227	if (ret) {
	228	printk(KERN_WARNING "ib_query_port failed (%d) for %s\n",
	229	ret, device->name);
	230	goto err;
	231	}
	232
	233	pkey_cache = kmalloc(sizeof pkey_cache + tprops->pkey_tbl_len
	234	sizeof *pkey_cache->table, GFP_KERNEL);
	235	if (!pkey_cache)
	236	goto err;
	237
	238	pkey_cache->table_len = tprops->pkey_tbl_len;
	239
	240	gid_cache = kmalloc(sizeof gid_cache + tprops->gid_tbl_len
	241	sizeof *gid_cache->table, GFP_KERNEL);
	242	if (!gid_cache)
	243	goto err;
	244
	245	gid_cache->table_len = tprops->gid_tbl_len;
	246
	247	for (i = 0; i < pkey_cache->table_len; ++i) {
	248	ret = ib_query_pkey(device, port, i, pkey_cache->table + i);
	249	if (ret) {
	250	printk(KERN_WARNING "ib_query_pkey failed (%d) for %s (index %d)\n",
	251	ret, device->name, i);
	252	goto err;
	253	}
	254	}
	255
	256	for (i = 0; i < gid_cache->table_len; ++i) {
	257	ret = ib_query_gid(device, port, i, gid_cache->table + i);
	258	if (ret) {
	259	printk(KERN_WARNING "ib_query_gid failed (%d) for %s (index %d)\n",
	260	ret, device->name, i);
	261	goto err;
	262	}
	263	}
	264
	265	write_lock_irq(&device->cache.lock);
	266
	267	old_pkey_cache = device->cache.pkey_cache[port - start_port(device)];
	268	old_gid_cache = device->cache.gid_cache [port - start_port(device)];
	269
	270	device->cache.pkey_cache[port - start_port(device)] = pkey_cache;
	271	device->cache.gid_cache [port - start_port(device)] = gid_cache;
	272
6fb9cdbf JM	273	device->cache.lmc_cache[port - start_port(device)] = tprops->lmc;
6fb9cdbf JM	274
1da177e4 LT	275	write_unlock_irq(&device->cache.lock);
	276
	277	kfree(old_pkey_cache);
	278	kfree(old_gid_cache);
	279	kfree(tprops);
	280	return;
	281
	282	err:
	283	kfree(pkey_cache);
	284	kfree(gid_cache);
	285	kfree(tprops);
	286	}
	287
	288	static void ib_cache_task(void *work_ptr)
	289	{
	290	struct ib_update_work *work = work_ptr;
	291
	292	ib_cache_update(work->device, work->port_num);
	293	kfree(work);
	294	}
	295
	296	static void ib_cache_event(struct ib_event_handler *handler,
	297	struct ib_event *event)
	298	{
	299	struct ib_update_work *work;
	300
	301	if (event->event == IB_EVENT_PORT_ERR \|\|
	302	event->event == IB_EVENT_PORT_ACTIVE \|\|
	303	event->event == IB_EVENT_LID_CHANGE \|\|
	304	event->event == IB_EVENT_PKEY_CHANGE \|\|
acaea9ee JM	305	event->event == IB_EVENT_SM_CHANGE \|\|
acaea9ee JM	306	event->event == IB_EVENT_CLIENT_REREGISTER) {
1da177e4 LT	307	work = kmalloc(sizeof *work, GFP_ATOMIC);
	308	if (work) {
	309	INIT_WORK(&work->work, ib_cache_task, work);
	310	work->device = event->device;
	311	work->port_num = event->element.port_num;
	312	schedule_work(&work->work);
	313	}
	314	}
	315	}
	316
	317	static void ib_cache_setup_one(struct ib_device *device)
	318	{
	319	int p;
	320
	321	rwlock_init(&device->cache.lock);
	322
	323	device->cache.pkey_cache =
	324	kmalloc(sizeof device->cache.pkey_cache
	325	(end_port(device) - start_port(device) + 1), GFP_KERNEL);
	326	device->cache.gid_cache =
ce684df0	327	kmalloc(sizeof device->cache.gid_cache
1da177e4 LT	328	(end_port(device) - start_port(device) + 1), GFP_KERNEL);
1da177e4 LT	329
6fb9cdbf JM	330	device->cache.lmc_cache = kmalloc(sizeof device->cache.lmc_cache
	331	(end_port(device) -
	332	start_port(device) + 1),
	333	GFP_KERNEL);
	334
	335	if (!device->cache.pkey_cache \|\| !device->cache.gid_cache \|\|
	336	!device->cache.lmc_cache) {
1da177e4 LT	337	printk(KERN_WARNING "Couldn't allocate cache "
	338	"for %s\n", device->name);
	339	goto err;
	340	}
	341
	342	for (p = 0; p <= end_port(device) - start_port(device); ++p) {
	343	device->cache.pkey_cache[p] = NULL;
	344	device->cache.gid_cache [p] = NULL;
	345	ib_cache_update(device, p + start_port(device));
	346	}
	347
	348	INIT_IB_EVENT_HANDLER(&device->cache.event_handler,
	349	device, ib_cache_event);
	350	if (ib_register_event_handler(&device->cache.event_handler))
	351	goto err_cache;
	352
	353	return;
	354
	355	err_cache:
	356	for (p = 0; p <= end_port(device) - start_port(device); ++p) {
	357	kfree(device->cache.pkey_cache[p]);
	358	kfree(device->cache.gid_cache[p]);
	359	}
	360
	361	err:
	362	kfree(device->cache.pkey_cache);
	363	kfree(device->cache.gid_cache);
6fb9cdbf	364	kfree(device->cache.lmc_cache);
1da177e4 LT	365	}
	366
	367	static void ib_cache_cleanup_one(struct ib_device *device)
	368	{
	369	int p;
	370
	371	ib_unregister_event_handler(&device->cache.event_handler);
	372	flush_scheduled_work();
	373
	374	for (p = 0; p <= end_port(device) - start_port(device); ++p) {
	375	kfree(device->cache.pkey_cache[p]);
	376	kfree(device->cache.gid_cache[p]);
	377	}
	378
	379	kfree(device->cache.pkey_cache);
	380	kfree(device->cache.gid_cache);
6fb9cdbf	381	kfree(device->cache.lmc_cache);
1da177e4 LT	382	}
	383
	384	static struct ib_client cache_client = {
	385	.name = "cache",
	386	.add = ib_cache_setup_one,
	387	.remove = ib_cache_cleanup_one
	388	};
	389
	390	int __init ib_cache_setup(void)
	391	{
	392	return ib_register_client(&cache_client);
	393	}
	394
	395	void __exit ib_cache_cleanup(void)
	396	{
	397	ib_unregister_client(&cache_client);
	398	}