addr.c 13.5 KB
Newer Older
1
2
3
4
5
6
/*
 * Copyright (c) 2005 Voltaire Inc.  All rights reserved.
 * Copyright (c) 2002-2005, Network Appliance, Inc. All rights reserved.
 * Copyright (c) 1999-2005, Mellanox Technologies, Inc. All rights reserved.
 * Copyright (c) 2005 Intel Corporation.  All rights reserved.
 *
Sean Hefty's avatar
Sean Hefty committed
7
8
9
10
11
 * 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:
12
 *
Sean Hefty's avatar
Sean Hefty committed
13
14
15
 *     Redistribution and use in source and binary forms, with or
 *     without modification, are permitted provided that the following
 *     conditions are met:
16
 *
Sean Hefty's avatar
Sean Hefty committed
17
18
19
 *      - Redistributions of source code must retain the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer.
20
 *
Sean Hefty's avatar
Sean Hefty committed
21
22
23
24
 *      - 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.
25
 *
Sean Hefty's avatar
Sean Hefty committed
26
27
28
29
30
31
32
33
 * 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.
34
35
36
37
 */

#include <linux/mutex.h>
#include <linux/inetdevice.h>
38
#include <linux/slab.h>
39
#include <linux/workqueue.h>
40
#include <linux/module.h>
41
42
43
#include <net/arp.h>
#include <net/neighbour.h>
#include <net/route.h>
44
#include <net/netevent.h>
45
46
#include <net/addrconf.h>
#include <net/ip6_route.h>
47
#include <rdma/ib_addr.h>
48
#include <rdma/ib.h>
49
50
51
52
53
54
55

MODULE_AUTHOR("Sean Hefty");
MODULE_DESCRIPTION("IB Address Translation");
MODULE_LICENSE("Dual BSD/GPL");

struct addr_req {
	struct list_head list;
56
57
	struct sockaddr_storage src_addr;
	struct sockaddr_storage dst_addr;
58
	struct rdma_dev_addr *addr;
59
	struct rdma_addr_client *client;
60
61
62
63
64
65
66
	void *context;
	void (*callback)(int status, struct sockaddr *src_addr,
			 struct rdma_dev_addr *addr, void *context);
	unsigned long timeout;
	int status;
};

David Howells's avatar
David Howells committed
67
static void process_req(struct work_struct *work);
68
69
70

static DEFINE_MUTEX(lock);
static LIST_HEAD(req_list);
David Howells's avatar
David Howells committed
71
static DECLARE_DELAYED_WORK(work, process_req);
72
73
static struct workqueue_struct *addr_wq;

74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
int rdma_addr_size(struct sockaddr *addr)
{
	switch (addr->sa_family) {
	case AF_INET:
		return sizeof(struct sockaddr_in);
	case AF_INET6:
		return sizeof(struct sockaddr_in6);
	case AF_IB:
		return sizeof(struct sockaddr_ib);
	default:
		return 0;
	}
}
EXPORT_SYMBOL(rdma_addr_size);

89
90
static struct rdma_addr_client self;

91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
void rdma_addr_register_client(struct rdma_addr_client *client)
{
	atomic_set(&client->refcount, 1);
	init_completion(&client->comp);
}
EXPORT_SYMBOL(rdma_addr_register_client);

static inline void put_client(struct rdma_addr_client *client)
{
	if (atomic_dec_and_test(&client->refcount))
		complete(&client->comp);
}

void rdma_addr_unregister_client(struct rdma_addr_client *client)
{
	put_client(client);
	wait_for_completion(&client->comp);
}
EXPORT_SYMBOL(rdma_addr_unregister_client);

Tom Tucker's avatar
Tom Tucker committed
111
112
int rdma_copy_addr(struct rdma_dev_addr *dev_addr, struct net_device *dev,
		     const unsigned char *dst_dev_addr)
113
{
114
	dev_addr->dev_type = dev->type;
115
116
117
118
	memcpy(dev_addr->src_dev_addr, dev->dev_addr, MAX_ADDR_LEN);
	memcpy(dev_addr->broadcast, dev->broadcast, MAX_ADDR_LEN);
	if (dst_dev_addr)
		memcpy(dev_addr->dst_dev_addr, dst_dev_addr, MAX_ADDR_LEN);
119
	dev_addr->bound_dev_if = dev->ifindex;
120
121
	return 0;
}
Tom Tucker's avatar
Tom Tucker committed
122
EXPORT_SYMBOL(rdma_copy_addr);
123

124
125
int rdma_translate_ip(struct sockaddr *addr, struct rdma_dev_addr *dev_addr,
		      u16 *vlan_id)
126
127
{
	struct net_device *dev;
128
	int ret = -EADDRNOTAVAIL;
129

130
131
132
133
134
135
136
137
138
	if (dev_addr->bound_dev_if) {
		dev = dev_get_by_index(&init_net, dev_addr->bound_dev_if);
		if (!dev)
			return -ENODEV;
		ret = rdma_copy_addr(dev_addr, dev, NULL);
		dev_put(dev);
		return ret;
	}

139
140
141
142
143
144
145
	switch (addr->sa_family) {
	case AF_INET:
		dev = ip_dev_find(&init_net,
			((struct sockaddr_in *) addr)->sin_addr.s_addr);

		if (!dev)
			return ret;
146

147
		ret = rdma_copy_addr(dev_addr, dev, NULL);
148
149
		if (vlan_id)
			*vlan_id = rdma_vlan_dev_vlan_id(dev);
150
151
		dev_put(dev);
		break;
152

153
#if IS_ENABLED(CONFIG_IPV6)
154
	case AF_INET6:
155
156
		rcu_read_lock();
		for_each_netdev_rcu(&init_net, dev) {
157
158
159
160
			if (ipv6_chk_addr(&init_net,
					  &((struct sockaddr_in6 *) addr)->sin6_addr,
					  dev, 1)) {
				ret = rdma_copy_addr(dev_addr, dev, NULL);
161
162
				if (vlan_id)
					*vlan_id = rdma_vlan_dev_vlan_id(dev);
163
164
165
				break;
			}
		}
166
		rcu_read_unlock();
167
		break;
168
#endif
169
	}
170
171
172
173
174
175
176
177
178
179
180
181
	return ret;
}
EXPORT_SYMBOL(rdma_translate_ip);

static void set_timeout(unsigned long time)
{
	unsigned long delay;

	delay = time - jiffies;
	if ((long)delay <= 0)
		delay = 1;

182
	mod_delayed_work(addr_wq, &work, delay);
183
184
185
186
187
188
189
190
}

static void queue_req(struct addr_req *req)
{
	struct addr_req *temp_req;

	mutex_lock(&lock);
	list_for_each_entry_reverse(temp_req, &req_list, list) {
191
		if (time_after_eq(req->timeout, temp_req->timeout))
192
193
194
195
196
197
198
199
200
201
			break;
	}

	list_add(&req->list, &temp_req->list);

	if (req_list.next == &req->list)
		set_timeout(req->timeout);
	mutex_unlock(&lock);
}

202
static int dst_fetch_ha(struct dst_entry *dst, struct rdma_dev_addr *dev_addr, void *daddr)
203
204
205
206
{
	struct neighbour *n;
	int ret;

207
208
	n = dst_neigh_lookup(dst, daddr);

209
210
211
212
213
214
	rcu_read_lock();
	if (!n || !(n->nud_state & NUD_VALID)) {
		if (n)
			neigh_event_send(n, NULL);
		ret = -ENODATA;
	} else {
215
		ret = rdma_copy_addr(dev_addr, dst->dev, n->ha);
216
217
218
	}
	rcu_read_unlock();

219
220
221
	if (n)
		neigh_release(n);

222
223
224
	return ret;
}

225
226
227
static int addr4_resolve(struct sockaddr_in *src_in,
			 struct sockaddr_in *dst_in,
			 struct rdma_dev_addr *addr)
228
{
229
230
	__be32 src_ip = src_in->sin_addr.s_addr;
	__be32 dst_ip = dst_in->sin_addr.s_addr;
231
	struct rtable *rt;
232
	struct flowi4 fl4;
233
234
	int ret;

235
236
237
238
239
	memset(&fl4, 0, sizeof(fl4));
	fl4.daddr = dst_ip;
	fl4.saddr = src_ip;
	fl4.flowi4_oif = addr->bound_dev_if;
	rt = ip_route_output_key(&init_net, &fl4);
240
241
	if (IS_ERR(rt)) {
		ret = PTR_ERR(rt);
242
		goto out;
243
	}
244
	src_in->sin_family = AF_INET;
245
	src_in->sin_addr.s_addr = fl4.saddr;
246

Eric Dumazet's avatar
Eric Dumazet committed
247
	if (rt->dst.dev->flags & IFF_LOOPBACK) {
248
		ret = rdma_translate_ip((struct sockaddr *)dst_in, addr, NULL);
249
250
251
252
253
		if (!ret)
			memcpy(addr->dst_dev_addr, addr->src_dev_addr, MAX_ADDR_LEN);
		goto put;
	}

254
	/* If the device does ARP internally, return 'done' */
Eric Dumazet's avatar
Eric Dumazet committed
255
	if (rt->dst.dev->flags & IFF_NOARP) {
256
		ret = rdma_copy_addr(addr, rt->dst.dev, NULL);
257
258
259
		goto put;
	}

260
	ret = dst_fetch_ha(&rt->dst, addr, &fl4.daddr);
261
262
263
264
265
266
put:
	ip_rt_put(rt);
out:
	return ret;
}

267
#if IS_ENABLED(CONFIG_IPV6)
Sean Hefty's avatar
Sean Hefty committed
268
269
270
static int addr6_resolve(struct sockaddr_in6 *src_in,
			 struct sockaddr_in6 *dst_in,
			 struct rdma_dev_addr *addr)
271
{
272
	struct flowi6 fl6;
273
	struct dst_entry *dst;
Sean Hefty's avatar
Sean Hefty committed
274
	int ret;
275

276
	memset(&fl6, 0, sizeof fl6);
Alexey Dobriyan's avatar
Alexey Dobriyan committed
277
278
	fl6.daddr = dst_in->sin6_addr;
	fl6.saddr = src_in->sin6_addr;
279
	fl6.flowi6_oif = addr->bound_dev_if;
280

281
	dst = ip6_route_output(&init_net, NULL, &fl6);
Sean Hefty's avatar
Sean Hefty committed
282
283
284
	if ((ret = dst->error))
		goto put;

285
	if (ipv6_addr_any(&fl6.saddr)) {
Sean Hefty's avatar
Sean Hefty committed
286
		ret = ipv6_dev_get_saddr(&init_net, ip6_dst_idev(dst)->dev,
287
					 &fl6.daddr, 0, &fl6.saddr);
Sean Hefty's avatar
Sean Hefty committed
288
289
		if (ret)
			goto put;
290

Sean Hefty's avatar
Sean Hefty committed
291
		src_in->sin6_family = AF_INET6;
Alexey Dobriyan's avatar
Alexey Dobriyan committed
292
		src_in->sin6_addr = fl6.saddr;
Sean Hefty's avatar
Sean Hefty committed
293
294
295
	}

	if (dst->dev->flags & IFF_LOOPBACK) {
296
		ret = rdma_translate_ip((struct sockaddr *)dst_in, addr, NULL);
Sean Hefty's avatar
Sean Hefty committed
297
298
299
300
301
302
		if (!ret)
			memcpy(addr->dst_dev_addr, addr->src_dev_addr, MAX_ADDR_LEN);
		goto put;
	}

	/* If the device does ARP internally, return 'done' */
303
304
	if (dst->dev->flags & IFF_NOARP) {
		ret = rdma_copy_addr(addr, dst->dev, NULL);
Sean Hefty's avatar
Sean Hefty committed
305
		goto put;
306
307
	}

308
	ret = dst_fetch_ha(dst, addr, &fl6.daddr);
Sean Hefty's avatar
Sean Hefty committed
309
put:
310
311
312
	dst_release(dst);
	return ret;
}
313
#else
Sean Hefty's avatar
Sean Hefty committed
314
315
316
static int addr6_resolve(struct sockaddr_in6 *src_in,
			 struct sockaddr_in6 *dst_in,
			 struct rdma_dev_addr *addr)
317
318
319
320
{
	return -EADDRNOTAVAIL;
}
#endif
321

322
323
324
static int addr_resolve(struct sockaddr *src_in,
			struct sockaddr *dst_in,
			struct rdma_dev_addr *addr)
325
326
{
	if (src_in->sa_family == AF_INET) {
327
		return addr4_resolve((struct sockaddr_in *) src_in,
328
329
			(struct sockaddr_in *) dst_in, addr);
	} else
Sean Hefty's avatar
Sean Hefty committed
330
		return addr6_resolve((struct sockaddr_in6 *) src_in,
331
332
333
			(struct sockaddr_in6 *) dst_in, addr);
}

David Howells's avatar
David Howells committed
334
static void process_req(struct work_struct *work)
335
336
{
	struct addr_req *req, *temp_req;
337
	struct sockaddr *src_in, *dst_in;
338
339
340
341
342
343
	struct list_head done_list;

	INIT_LIST_HEAD(&done_list);

	mutex_lock(&lock);
	list_for_each_entry_safe(req, temp_req, &req_list, list) {
344
		if (req->status == -ENODATA) {
345
346
			src_in = (struct sockaddr *) &req->src_addr;
			dst_in = (struct sockaddr *) &req->dst_addr;
347
			req->status = addr_resolve(src_in, dst_in, req->addr);
348
349
350
351
			if (req->status && time_after_eq(jiffies, req->timeout))
				req->status = -ETIMEDOUT;
			else if (req->status == -ENODATA)
				continue;
352
		}
353
		list_move_tail(&req->list, &done_list);
354
355
356
357
358
359
360
361
362
363
	}

	if (!list_empty(&req_list)) {
		req = list_entry(req_list.next, struct addr_req, list);
		set_timeout(req->timeout);
	}
	mutex_unlock(&lock);

	list_for_each_entry_safe(req, temp_req, &done_list, list) {
		list_del(&req->list);
364
365
		req->callback(req->status, (struct sockaddr *) &req->src_addr,
			req->addr, req->context);
366
		put_client(req->client);
367
368
369
370
		kfree(req);
	}
}

371
372
int rdma_resolve_ip(struct rdma_addr_client *client,
		    struct sockaddr *src_addr, struct sockaddr *dst_addr,
373
374
375
376
377
		    struct rdma_dev_addr *addr, int timeout_ms,
		    void (*callback)(int status, struct sockaddr *src_addr,
				     struct rdma_dev_addr *addr, void *context),
		    void *context)
{
378
	struct sockaddr *src_in, *dst_in;
379
380
381
	struct addr_req *req;
	int ret = 0;

382
	req = kzalloc(sizeof *req, GFP_KERNEL);
383
384
385
	if (!req)
		return -ENOMEM;

386
387
388
389
390
391
392
393
394
	src_in = (struct sockaddr *) &req->src_addr;
	dst_in = (struct sockaddr *) &req->dst_addr;

	if (src_addr) {
		if (src_addr->sa_family != dst_addr->sa_family) {
			ret = -EINVAL;
			goto err;
		}

395
		memcpy(src_in, src_addr, rdma_addr_size(src_addr));
396
397
398
399
	} else {
		src_in->sa_family = dst_addr->sa_family;
	}

400
	memcpy(dst_in, dst_addr, rdma_addr_size(dst_addr));
401
402
403
	req->addr = addr;
	req->callback = callback;
	req->context = context;
404
405
	req->client = client;
	atomic_inc(&client->refcount);
406

Sean Hefty's avatar
Sean Hefty committed
407
	req->status = addr_resolve(src_in, dst_in, addr);
408
409
410
411
412
413
414
415
416
417
418
	switch (req->status) {
	case 0:
		req->timeout = jiffies;
		queue_req(req);
		break;
	case -ENODATA:
		req->timeout = msecs_to_jiffies(timeout_ms) + jiffies;
		queue_req(req);
		break;
	default:
		ret = req->status;
419
		atomic_dec(&client->refcount);
420
		goto err;
421
422
	}
	return ret;
423
424
425
err:
	kfree(req);
	return ret;
426
427
428
429
430
431
432
433
434
435
436
437
}
EXPORT_SYMBOL(rdma_resolve_ip);

void rdma_addr_cancel(struct rdma_dev_addr *addr)
{
	struct addr_req *req, *temp_req;

	mutex_lock(&lock);
	list_for_each_entry_safe(req, temp_req, &req_list, list) {
		if (req->addr == addr) {
			req->status = -ECANCELED;
			req->timeout = jiffies;
438
			list_move(&req->list, &req_list);
439
440
441
442
443
444
445
446
			set_timeout(req->timeout);
			break;
		}
	}
	mutex_unlock(&lock);
}
EXPORT_SYMBOL(rdma_addr_cancel);

447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
struct resolve_cb_context {
	struct rdma_dev_addr *addr;
	struct completion comp;
};

static void resolve_cb(int status, struct sockaddr *src_addr,
	     struct rdma_dev_addr *addr, void *context)
{
	memcpy(((struct resolve_cb_context *)context)->addr, addr, sizeof(struct
				rdma_dev_addr));
	complete(&((struct resolve_cb_context *)context)->comp);
}

int rdma_addr_find_dmac_by_grh(union ib_gid *sgid, union ib_gid *dgid, u8 *dmac,
			       u16 *vlan_id)
{
	int ret = 0;
	struct rdma_dev_addr dev_addr;
	struct resolve_cb_context ctx;
	struct net_device *dev;

	union {
		struct sockaddr     _sockaddr;
		struct sockaddr_in  _sockaddr_in;
		struct sockaddr_in6 _sockaddr_in6;
	} sgid_addr, dgid_addr;


	ret = rdma_gid2ip(&sgid_addr._sockaddr, sgid);
	if (ret)
		return ret;

	ret = rdma_gid2ip(&dgid_addr._sockaddr, dgid);
	if (ret)
		return ret;

	memset(&dev_addr, 0, sizeof(dev_addr));

	ctx.addr = &dev_addr;
	init_completion(&ctx.comp);
	ret = rdma_resolve_ip(&self, &sgid_addr._sockaddr, &dgid_addr._sockaddr,
			&dev_addr, 1000, resolve_cb, &ctx);
	if (ret)
		return ret;

	wait_for_completion(&ctx.comp);

	memcpy(dmac, dev_addr.dst_dev_addr, ETH_ALEN);
	dev = dev_get_by_index(&init_net, dev_addr.bound_dev_if);
	if (!dev)
		return -ENODEV;
	if (vlan_id)
		*vlan_id = rdma_vlan_dev_vlan_id(dev);
	dev_put(dev);
	return ret;
}
EXPORT_SYMBOL(rdma_addr_find_dmac_by_grh);

int rdma_addr_find_smac_by_sgid(union ib_gid *sgid, u8 *smac, u16 *vlan_id)
{
	int ret = 0;
	struct rdma_dev_addr dev_addr;
	union {
		struct sockaddr     _sockaddr;
		struct sockaddr_in  _sockaddr_in;
		struct sockaddr_in6 _sockaddr_in6;
	} gid_addr;

	ret = rdma_gid2ip(&gid_addr._sockaddr, sgid);

	if (ret)
		return ret;
	memset(&dev_addr, 0, sizeof(dev_addr));
	ret = rdma_translate_ip(&gid_addr._sockaddr, &dev_addr, vlan_id);
	if (ret)
		return ret;

	memcpy(smac, dev_addr.src_dev_addr, ETH_ALEN);
	return ret;
}
EXPORT_SYMBOL(rdma_addr_find_smac_by_sgid);

Roland Dreier's avatar
Roland Dreier committed
529
static int netevent_callback(struct notifier_block *self, unsigned long event,
530
	void *ctx)
531
{
Roland Dreier's avatar
Roland Dreier committed
532
	if (event == NETEVENT_NEIGH_UPDATE) {
533
		struct neighbour *neigh = ctx;
534

535
		if (neigh->nud_state & NUD_VALID) {
536
537
538
			set_timeout(jiffies);
		}
	}
539
540
541
	return 0;
}

542
543
static struct notifier_block nb = {
	.notifier_call = netevent_callback
544
545
};

546
static int __init addr_init(void)
547
{
548
	addr_wq = create_singlethread_workqueue("ib_addr");
549
550
551
	if (!addr_wq)
		return -ENOMEM;

552
	register_netevent_notifier(&nb);
553
	rdma_addr_register_client(&self);
554
555
556
	return 0;
}

557
static void __exit addr_cleanup(void)
558
{
559
	rdma_addr_unregister_client(&self);
560
	unregister_netevent_notifier(&nb);
561
562
563
564
565
	destroy_workqueue(addr_wq);
}

module_init(addr_init);
module_exit(addr_cleanup);