projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Linux 3.0-rc7
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / infiniband / core / cma.c
CommitLineData
e51060f0
SH		 1/*
2 * Copyright (c) 2005 Voltaire Inc. All rights reserved.
3 * Copyright (c) 2002-2005, Network Appliance, Inc. All rights reserved.
4 * Copyright (c) 1999-2005, Mellanox Technologies, Inc. All rights reserved.
5 * Copyright (c) 2005-2006 Intel Corporation. All rights reserved.
6 *
a9474917
SH		 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:
e51060f0 12 *
a9474917
SH		 13 * Redistribution and use in source and binary forms, with or
14 * without modification, are permitted provided that the following
15 * conditions are met:
e51060f0 16 *
a9474917
SH		 17 * - Redistributions of source code must retain the above
18 * copyright notice, this list of conditions and the following
19 * disclaimer.
e51060f0 20 *
a9474917
SH		 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.
e51060f0 25 *
a9474917
SH		 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.
e51060f0
SH		 34 */
35
36#include <linux/completion.h>
37#include <linux/in.h>
38#include <linux/in6.h>
39#include <linux/mutex.h>
40#include <linux/random.h>
41#include <linux/idr.h>
07ebafba 42#include <linux/inetdevice.h>
5a0e3ad6 43#include <linux/slab.h>
e51060f0
SH		 44
45#include <net/tcp.h>
1f5175ad 46#include <net/ipv6.h>
e51060f0
SH		 47
48#include <rdma/rdma_cm.h>
49#include <rdma/rdma_cm_ib.h>
753f618a 50#include <rdma/rdma_netlink.h>
e51060f0
SH		 51#include <rdma/ib_cache.h>
52#include <rdma/ib_cm.h>
53#include <rdma/ib_sa.h>
07ebafba 54#include <rdma/iw_cm.h>
e51060f0
SH		 55
56MODULE_AUTHOR("Sean Hefty");
57MODULE_DESCRIPTION("Generic RDMA CM Agent");
58MODULE_LICENSE("Dual BSD/GPL");
59
60#define CMA_CM_RESPONSE_TIMEOUT 20
d5bb7599 61#define CMA_MAX_CM_RETRIES 15
dcb3f974 62#define CMA_CM_MRA_SETTING (IB_CM_MRA_FLAG_DELAY | 24)
3c86aa70 63#define CMA_IBOE_PACKET_LIFETIME 18
e51060f0
SH		 64
65static void cma_add_one(struct ib_device *device);
66static void cma_remove_one(struct ib_device *device);
67
68static struct ib_client cma_client = {
69 .name = "cma",
70 .add = cma_add_one,
71 .remove = cma_remove_one
72};
73
c1a0b23b 74static struct ib_sa_client sa_client;
7a118df3 75static struct rdma_addr_client addr_client;
e51060f0
SH		 76static LIST_HEAD(dev_list);
77static LIST_HEAD(listen_any_list);
78static DEFINE_MUTEX(lock);
79static struct workqueue_struct *cma_wq;
80static DEFINE_IDR(sdp_ps);
81static DEFINE_IDR(tcp_ps);
628e5f6d 82static DEFINE_IDR(udp_ps);
c8f6a362 83static DEFINE_IDR(ipoib_ps);
e51060f0
SH		 84
85struct cma_device {
86 struct list_head list;
87 struct ib_device *device;
e51060f0
SH		 88 struct completion comp;
89 atomic_t refcount;
90 struct list_head id_list;
91};
92
e51060f0
SH		 93struct rdma_bind_list {
94 struct idr *ps;
95 struct hlist_head owners;
96 unsigned short port;
97};
98
99/*
100 * Device removal can occur at anytime, so we need extra handling to
101 * serialize notifying the user of device removal with other callbacks.
102 * We do this by disabling removal notification while a callback is in process,
103 * and reporting it after the callback completes.
104 */
105struct rdma_id_private {
106 struct rdma_cm_id id;
107
108 struct rdma_bind_list *bind_list;
109 struct hlist_node node;
d02d1f53
SH		 110 struct list_head list; /* listen_any_list or cma_device.list */
111 struct list_head listen_list; /* per device listens */
e51060f0 112 struct cma_device *cma_dev;
c8f6a362 113 struct list_head mc_list;
e51060f0 114
d02d1f53 115 int internal_id;
550e5ca7 116 enum rdma_cm_state state;
e51060f0 117 spinlock_t lock;
c5483388
SH		 118 struct mutex qp_mutex;
119
e51060f0
SH		 120 struct completion comp;
121 atomic_t refcount;
de910bd9 122 struct mutex handler_mutex;
e51060f0
SH		 123
124 int backlog;
125 int timeout_ms;
126 struct ib_sa_query *query;
127 int query_id;
128 union {
129 struct ib_cm_id *ib;
07ebafba 130 struct iw_cm_id *iw;
e51060f0
SH		 131 } cm_id;
132
133 u32 seq_num;
c8f6a362 134 u32 qkey;
e51060f0 135 u32 qp_num;
83e9502d 136 pid_t owner;
e51060f0 137 u8 srq;
a81c994d 138 u8 tos;
a9bb7912 139 u8 reuseaddr;
e51060f0
SH		 140};
141
c8f6a362
SH		 142struct cma_multicast {
143 struct rdma_id_private *id_priv;
144 union {
145 struct ib_sa_multicast *ib;
146 } multicast;
147 struct list_head list;
148 void *context;
3f446754 149 struct sockaddr_storage addr;
3c86aa70 150 struct kref mcref;
c8f6a362
SH		 151};
152
e51060f0
SH		 153struct cma_work {
154 struct work_struct work;
155 struct rdma_id_private *id;
550e5ca7
NM		 156 enum rdma_cm_state old_state;
157 enum rdma_cm_state new_state;
e51060f0
SH		 158 struct rdma_cm_event event;
159};
160
dd5bdff8
OG		 161struct cma_ndev_work {
162 struct work_struct work;
163 struct rdma_id_private *id;
164 struct rdma_cm_event event;
165};
166
3c86aa70
EC		 167struct iboe_mcast_work {
168 struct work_struct work;
169 struct rdma_id_private *id;
170 struct cma_multicast *mc;
171};
172
e51060f0
SH		 173union cma_ip_addr {
174 struct in6_addr ip6;
175 struct {
1b90c137
AV		 176 __be32 pad[3];
177 __be32 addr;
e51060f0
SH		 178 } ip4;
179};
180
181struct cma_hdr {
182 u8 cma_version;
183 u8 ip_version; /* IP version: 7:4 */
1b90c137 184 __be16 port;
e51060f0
SH		 185 union cma_ip_addr src_addr;
186 union cma_ip_addr dst_addr;
187};
188
189struct sdp_hh {
190 u8 bsdh[16];
191 u8 sdp_version; /* Major version: 7:4 */
192 u8 ip_version; /* IP version: 7:4 */
193 u8 sdp_specific1[10];
1b90c137
AV		 194 __be16 port;
195 __be16 sdp_specific2;
e51060f0
SH		 196 union cma_ip_addr src_addr;
197 union cma_ip_addr dst_addr;
198};
199
200struct sdp_hah {
201 u8 bsdh[16];
202 u8 sdp_version;
203};
204
205#define CMA_VERSION 0x00
206#define SDP_MAJ_VERSION 0x2
207
550e5ca7 208static int cma_comp(struct rdma_id_private *id_priv, enum rdma_cm_state comp)
e51060f0
SH		 209{
210 unsigned long flags;
211 int ret;
212
213 spin_lock_irqsave(&id_priv->lock, flags);
214 ret = (id_priv->state == comp);
215 spin_unlock_irqrestore(&id_priv->lock, flags);
216 return ret;
217}
218
219static int cma_comp_exch(struct rdma_id_private *id_priv,
550e5ca7 220 enum rdma_cm_state comp, enum rdma_cm_state exch)
e51060f0
SH		 221{
222 unsigned long flags;
223 int ret;
224
225 spin_lock_irqsave(&id_priv->lock, flags);
226 if ((ret = (id_priv->state == comp)))
227 id_priv->state = exch;
228 spin_unlock_irqrestore(&id_priv->lock, flags);
229 return ret;
230}
231
550e5ca7
NM		 232static enum rdma_cm_state cma_exch(struct rdma_id_private *id_priv,
233 enum rdma_cm_state exch)
e51060f0
SH		 234{
235 unsigned long flags;
550e5ca7 236 enum rdma_cm_state old;
e51060f0
SH		 237
238 spin_lock_irqsave(&id_priv->lock, flags);
239 old = id_priv->state;
240 id_priv->state = exch;
241 spin_unlock_irqrestore(&id_priv->lock, flags);
242 return old;
243}
244
245static inline u8 cma_get_ip_ver(struct cma_hdr *hdr)
246{
247 return hdr->ip_version >> 4;
248}
249
250static inline void cma_set_ip_ver(struct cma_hdr *hdr, u8 ip_ver)
251{
252 hdr->ip_version = (ip_ver << 4) | (hdr->ip_version & 0xF);
253}
254
255static inline u8 sdp_get_majv(u8 sdp_version)
256{
257 return sdp_version >> 4;
258}
259
260static inline u8 sdp_get_ip_ver(struct sdp_hh *hh)
261{
262 return hh->ip_version >> 4;
263}
264
265static inline void sdp_set_ip_ver(struct sdp_hh *hh, u8 ip_ver)
266{
267 hh->ip_version = (ip_ver << 4) | (hh->ip_version & 0xF);
268}
269
270static void cma_attach_to_dev(struct rdma_id_private *id_priv,
271 struct cma_device *cma_dev)
272{
273 atomic_inc(&cma_dev->refcount);
274 id_priv->cma_dev = cma_dev;
275 id_priv->id.device = cma_dev->device;
3c86aa70
EC		 276 id_priv->id.route.addr.dev_addr.transport =
277 rdma_node_get_transport(cma_dev->device->node_type);
e51060f0
SH		 278 list_add_tail(&id_priv->list, &cma_dev->id_list);
279}
280
281static inline void cma_deref_dev(struct cma_device *cma_dev)
282{
283 if (atomic_dec_and_test(&cma_dev->refcount))
284 complete(&cma_dev->comp);
285}
286
3c86aa70
EC		 287static inline void release_mc(struct kref *kref)
288{
289 struct cma_multicast *mc = container_of(kref, struct cma_multicast, mcref);
290
291 kfree(mc->multicast.ib);
292 kfree(mc);
293}
294
a396d43a 295static void cma_release_dev(struct rdma_id_private *id_priv)
e51060f0 296{
a396d43a 297 mutex_lock(&lock);
e51060f0
SH		 298 list_del(&id_priv->list);
299 cma_deref_dev(id_priv->cma_dev);
300 id_priv->cma_dev = NULL;
a396d43a 301 mutex_unlock(&lock);
e51060f0
SH		 302}
303
d2ca39f2 304static int cma_set_qkey(struct rdma_id_private *id_priv)
c8f6a362
SH		 305{
306 struct ib_sa_mcmember_rec rec;
307 int ret = 0;
308
d2ca39f2
YE		 309 if (id_priv->qkey)
310 return 0;
311
312 switch (id_priv->id.ps) {
c8f6a362 313 case RDMA_PS_UDP:
d2ca39f2 314 id_priv->qkey = RDMA_UDP_QKEY;
c8f6a362
SH		 315 break;
316 case RDMA_PS_IPOIB:
d2ca39f2
YE		 317 ib_addr_get_mgid(&id_priv->id.route.addr.dev_addr, &rec.mgid);
318 ret = ib_sa_get_mcmember_rec(id_priv->id.device,
319 id_priv->id.port_num, &rec.mgid,
320 &rec);
321 if (!ret)
322 id_priv->qkey = be32_to_cpu(rec.qkey);
c8f6a362
SH		 323 break;
324 default:
325 break;
326 }
327 return ret;
328}
329
3c86aa70
EC		 330static int find_gid_port(struct ib_device *device, union ib_gid *gid, u8 port_num)
331{
332 int i;
333 int err;
334 struct ib_port_attr props;
335 union ib_gid tmp;
336
337 err = ib_query_port(device, port_num, &props);
338 if (err)
339 return 1;
340
341 for (i = 0; i < props.gid_tbl_len; ++i) {
342 err = ib_query_gid(device, port_num, i, &tmp);
343 if (err)
344 return 1;
345 if (!memcmp(&tmp, gid, sizeof tmp))
346 return 0;
347 }
348
349 return -EAGAIN;
350}
351
07ebafba 352static int cma_acquire_dev(struct rdma_id_private *id_priv)
e51060f0 353{
c8f6a362 354 struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr;
e51060f0 355 struct cma_device *cma_dev;
3c86aa70 356 union ib_gid gid, iboe_gid;
e51060f0 357 int ret = -ENODEV;
3c86aa70
EC		 358 u8 port;
359 enum rdma_link_layer dev_ll = dev_addr->dev_type == ARPHRD_INFINIBAND ?
360 IB_LINK_LAYER_INFINIBAND : IB_LINK_LAYER_ETHERNET;
e51060f0 361
a396d43a 362 mutex_lock(&lock);
3c86aa70
EC		 363 iboe_addr_get_sgid(dev_addr, &iboe_gid);
364 memcpy(&gid, dev_addr->src_dev_addr +
365 rdma_addr_gid_offset(dev_addr), sizeof gid);
e51060f0 366 list_for_each_entry(cma_dev, &dev_list, list) {
3c86aa70
EC		 367 for (port = 1; port <= cma_dev->device->phys_port_cnt; ++port) {
368 if (rdma_port_get_link_layer(cma_dev->device, port) == dev_ll) {
369 if (rdma_node_get_transport(cma_dev->device->node_type) == RDMA_TRANSPORT_IB &&
370 rdma_port_get_link_layer(cma_dev->device, port) == IB_LINK_LAYER_ETHERNET)
371 ret = find_gid_port(cma_dev->device, &iboe_gid, port);
372 else
373 ret = find_gid_port(cma_dev->device, &gid, port);
374
375 if (!ret) {
376 id_priv->id.port_num = port;
377 goto out;
378 } else if (ret == 1)
379 break;
380 }
e51060f0
SH		 381 }
382 }
3c86aa70
EC		 383
384out:
385 if (!ret)
386 cma_attach_to_dev(id_priv, cma_dev);
387
a396d43a 388 mutex_unlock(&lock);
e51060f0
SH		 389 return ret;
390}
391
e51060f0
SH		 392static void cma_deref_id(struct rdma_id_private *id_priv)
393{
394 if (atomic_dec_and_test(&id_priv->refcount))
395 complete(&id_priv->comp);
396}
397
de910bd9 398static int cma_disable_callback(struct rdma_id_private *id_priv,
550e5ca7 399 enum rdma_cm_state state)
8aa08602 400{
de910bd9
OG		 401 mutex_lock(&id_priv->handler_mutex);
402 if (id_priv->state != state) {
403 mutex_unlock(&id_priv->handler_mutex);
404 return -EINVAL;
405 }
406 return 0;
e51060f0
SH		 407}
408
6c719f5c
SH		 409static int cma_has_cm_dev(struct rdma_id_private *id_priv)
410{
411 return (id_priv->id.device && id_priv->cm_id.ib);
412}
413
e51060f0 414struct rdma_cm_id *rdma_create_id(rdma_cm_event_handler event_handler,
b26f9b99
SH		 415 void *context, enum rdma_port_space ps,
416 enum ib_qp_type qp_type)
e51060f0
SH		 417{
418 struct rdma_id_private *id_priv;
419
420 id_priv = kzalloc(sizeof *id_priv, GFP_KERNEL);
421 if (!id_priv)
422 return ERR_PTR(-ENOMEM);
423
83e9502d 424 id_priv->owner = task_pid_nr(current);
550e5ca7 425 id_priv->state = RDMA_CM_IDLE;
e51060f0
SH		 426 id_priv->id.context = context;
427 id_priv->id.event_handler = event_handler;
428 id_priv->id.ps = ps;
b26f9b99 429 id_priv->id.qp_type = qp_type;
e51060f0 430 spin_lock_init(&id_priv->lock);
c5483388 431 mutex_init(&id_priv->qp_mutex);
e51060f0
SH		 432 init_completion(&id_priv->comp);
433 atomic_set(&id_priv->refcount, 1);
de910bd9 434 mutex_init(&id_priv->handler_mutex);
e51060f0 435 INIT_LIST_HEAD(&id_priv->listen_list);
c8f6a362 436 INIT_LIST_HEAD(&id_priv->mc_list);
e51060f0
SH		 437 get_random_bytes(&id_priv->seq_num, sizeof id_priv->seq_num);
438
439 return &id_priv->id;
440}
441EXPORT_SYMBOL(rdma_create_id);
442
c8f6a362 443static int cma_init_ud_qp(struct rdma_id_private *id_priv, struct ib_qp *qp)
e51060f0
SH		 444{
445 struct ib_qp_attr qp_attr;
c8f6a362 446 int qp_attr_mask, ret;
e51060f0 447
c8f6a362
SH		 448 qp_attr.qp_state = IB_QPS_INIT;
449 ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask);
e51060f0
SH		 450 if (ret)
451 return ret;
452
c8f6a362
SH		 453 ret = ib_modify_qp(qp, &qp_attr, qp_attr_mask);
454 if (ret)
455 return ret;
456
457 qp_attr.qp_state = IB_QPS_RTR;
458 ret = ib_modify_qp(qp, &qp_attr, IB_QP_STATE);
459 if (ret)
460 return ret;
461
462 qp_attr.qp_state = IB_QPS_RTS;
463 qp_attr.sq_psn = 0;
464 ret = ib_modify_qp(qp, &qp_attr, IB_QP_STATE | IB_QP_SQ_PSN);
465
466 return ret;
e51060f0
SH		 467}
468
c8f6a362 469static int cma_init_conn_qp(struct rdma_id_private *id_priv, struct ib_qp *qp)
07ebafba
TT		 470{
471 struct ib_qp_attr qp_attr;
c8f6a362 472 int qp_attr_mask, ret;
07ebafba
TT		 473
474 qp_attr.qp_state = IB_QPS_INIT;
c8f6a362
SH		 475 ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask);
476 if (ret)
477 return ret;
07ebafba 478
c8f6a362 479 return ib_modify_qp(qp, &qp_attr, qp_attr_mask);
07ebafba
TT		 480}
481
e51060f0
SH		 482int rdma_create_qp(struct rdma_cm_id *id, struct ib_pd *pd,
483 struct ib_qp_init_attr *qp_init_attr)
484{
485 struct rdma_id_private *id_priv;
486 struct ib_qp *qp;
487 int ret;
488
489 id_priv = container_of(id, struct rdma_id_private, id);
490 if (id->device != pd->device)
491 return -EINVAL;
492
493 qp = ib_create_qp(pd, qp_init_attr);
494 if (IS_ERR(qp))
495 return PTR_ERR(qp);
496
b26f9b99 497 if (id->qp_type == IB_QPT_UD)
c8f6a362
SH		 498 ret = cma_init_ud_qp(id_priv, qp);
499 else
500 ret = cma_init_conn_qp(id_priv, qp);
e51060f0
SH		 501 if (ret)
502 goto err;
503
504 id->qp = qp;
505 id_priv->qp_num = qp->qp_num;
e51060f0
SH		 506 id_priv->srq = (qp->srq != NULL);
507 return 0;
508err:
509 ib_destroy_qp(qp);
510 return ret;
511}
512EXPORT_SYMBOL(rdma_create_qp);
513
514void rdma_destroy_qp(struct rdma_cm_id *id)
515{
c5483388
SH		 516 struct rdma_id_private *id_priv;
517
518 id_priv = container_of(id, struct rdma_id_private, id);
519 mutex_lock(&id_priv->qp_mutex);
520 ib_destroy_qp(id_priv->id.qp);
521 id_priv->id.qp = NULL;
522 mutex_unlock(&id_priv->qp_mutex);
e51060f0
SH		 523}
524EXPORT_SYMBOL(rdma_destroy_qp);
525
5851bb89
SH		 526static int cma_modify_qp_rtr(struct rdma_id_private *id_priv,
527 struct rdma_conn_param *conn_param)
e51060f0
SH		 528{
529 struct ib_qp_attr qp_attr;
530 int qp_attr_mask, ret;
531
c5483388
SH		 532 mutex_lock(&id_priv->qp_mutex);
533 if (!id_priv->id.qp) {
534 ret = 0;
535 goto out;
536 }
e51060f0
SH		 537
538 /* Need to update QP attributes from default values. */
539 qp_attr.qp_state = IB_QPS_INIT;
c5483388 540 ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask);
e51060f0 541 if (ret)
c5483388 542 goto out;
e51060f0 543
c5483388 544 ret = ib_modify_qp(id_priv->id.qp, &qp_attr, qp_attr_mask);
e51060f0 545 if (ret)
c5483388 546 goto out;
e51060f0
SH		 547
548 qp_attr.qp_state = IB_QPS_RTR;
c5483388 549 ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask);
e51060f0 550 if (ret)
c5483388 551 goto out;
e51060f0 552
5851bb89
SH		 553 if (conn_param)
554 qp_attr.max_dest_rd_atomic = conn_param->responder_resources;
c5483388
SH		 555 ret = ib_modify_qp(id_priv->id.qp, &qp_attr, qp_attr_mask);
556out:
557 mutex_unlock(&id_priv->qp_mutex);
558 return ret;
e51060f0
SH		 559}
560
5851bb89
SH		 561static int cma_modify_qp_rts(struct rdma_id_private *id_priv,
562 struct rdma_conn_param *conn_param)
e51060f0
SH		 563{
564 struct ib_qp_attr qp_attr;
565 int qp_attr_mask, ret;
566
c5483388
SH		 567 mutex_lock(&id_priv->qp_mutex);
568 if (!id_priv->id.qp) {
569 ret = 0;
570 goto out;
571 }
e51060f0
SH		 572
573 qp_attr.qp_state = IB_QPS_RTS;
c5483388 574 ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask);
e51060f0 575 if (ret)
c5483388 576 goto out;
e51060f0 577
5851bb89
SH		 578 if (conn_param)
579 qp_attr.max_rd_atomic = conn_param->initiator_depth;
c5483388
SH		 580 ret = ib_modify_qp(id_priv->id.qp, &qp_attr, qp_attr_mask);
581out:
582 mutex_unlock(&id_priv->qp_mutex);
583 return ret;
e51060f0
SH		 584}
585
c5483388 586static int cma_modify_qp_err(struct rdma_id_private *id_priv)
e51060f0
SH		 587{
588 struct ib_qp_attr qp_attr;
c5483388 589 int ret;
e51060f0 590
c5483388
SH		 591 mutex_lock(&id_priv->qp_mutex);
592 if (!id_priv->id.qp) {
593 ret = 0;
594 goto out;
595 }
e51060f0
SH		 596
597 qp_attr.qp_state = IB_QPS_ERR;
c5483388
SH		 598 ret = ib_modify_qp(id_priv->id.qp, &qp_attr, IB_QP_STATE);
599out:
600 mutex_unlock(&id_priv->qp_mutex);
601 return ret;
e51060f0
SH		 602}
603
c8f6a362
SH		 604static int cma_ib_init_qp_attr(struct rdma_id_private *id_priv,
605 struct ib_qp_attr *qp_attr, int *qp_attr_mask)
606{
607 struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr;
608 int ret;
3c86aa70
EC		 609 u16 pkey;
610
611 if (rdma_port_get_link_layer(id_priv->id.device, id_priv->id.port_num) ==
612 IB_LINK_LAYER_INFINIBAND)
613 pkey = ib_addr_get_pkey(dev_addr);
614 else
615 pkey = 0xffff;
c8f6a362
SH		 616
617 ret = ib_find_cached_pkey(id_priv->id.device, id_priv->id.port_num,
3c86aa70 618 pkey, &qp_attr->pkey_index);
c8f6a362
SH		 619 if (ret)
620 return ret;
621
622 qp_attr->port_num = id_priv->id.port_num;
623 *qp_attr_mask = IB_QP_STATE | IB_QP_PKEY_INDEX | IB_QP_PORT;
624
b26f9b99 625 if (id_priv->id.qp_type == IB_QPT_UD) {
d2ca39f2
YE		 626 ret = cma_set_qkey(id_priv);
627 if (ret)
628 return ret;
629
c8f6a362
SH		 630 qp_attr->qkey = id_priv->qkey;
631 *qp_attr_mask |= IB_QP_QKEY;
632 } else {
633 qp_attr->qp_access_flags = 0;
634 *qp_attr_mask |= IB_QP_ACCESS_FLAGS;
635 }
636 return 0;
637}
638
e51060f0
SH		 639int rdma_init_qp_attr(struct rdma_cm_id *id, struct ib_qp_attr *qp_attr,
640 int *qp_attr_mask)
641{
642 struct rdma_id_private *id_priv;
c8f6a362 643 int ret = 0;
e51060f0
SH		 644
645 id_priv = container_of(id, struct rdma_id_private, id);
07ebafba
TT		 646 switch (rdma_node_get_transport(id_priv->id.device->node_type)) {
647 case RDMA_TRANSPORT_IB:
b26f9b99 648 if (!id_priv->cm_id.ib || (id_priv->id.qp_type == IB_QPT_UD))
c8f6a362
SH		 649 ret = cma_ib_init_qp_attr(id_priv, qp_attr, qp_attr_mask);
650 else
651 ret = ib_cm_init_qp_attr(id_priv->cm_id.ib, qp_attr,
652 qp_attr_mask);
e51060f0
SH		 653 if (qp_attr->qp_state == IB_QPS_RTR)
654 qp_attr->rq_psn = id_priv->seq_num;
655 break;
07ebafba 656 case RDMA_TRANSPORT_IWARP:
c8f6a362 657 if (!id_priv->cm_id.iw) {
8f076531 658 qp_attr->qp_access_flags = 0;
c8f6a362
SH		 659 *qp_attr_mask = IB_QP_STATE | IB_QP_ACCESS_FLAGS;
660 } else
661 ret = iw_cm_init_qp_attr(id_priv->cm_id.iw, qp_attr,
662 qp_attr_mask);
07ebafba 663 break;
e51060f0
SH		 664 default:
665 ret = -ENOSYS;
666 break;
667 }
668
669 return ret;
670}
671EXPORT_SYMBOL(rdma_init_qp_attr);
672
673static inline int cma_zero_addr(struct sockaddr *addr)
674{
675 struct in6_addr *ip6;
676
677 if (addr->sa_family == AF_INET)
6360a02a
JP		 678 return ipv4_is_zeronet(
679 ((struct sockaddr_in *)addr)->sin_addr.s_addr);
e51060f0
SH		 680 else {
681 ip6 = &((struct sockaddr_in6 *) addr)->sin6_addr;
682 return (ip6->s6_addr32[0] | ip6->s6_addr32[1] |
5fd571cb 683 ip6->s6_addr32[2] | ip6->s6_addr32[3]) == 0;
e51060f0
SH		 684 }
685}
686
687static inline int cma_loopback_addr(struct sockaddr *addr)
688{
1f5175ad
AS		 689 if (addr->sa_family == AF_INET)
690 return ipv4_is_loopback(
691 ((struct sockaddr_in *) addr)->sin_addr.s_addr);
692 else
693 return ipv6_addr_loopback(
694 &((struct sockaddr_in6 *) addr)->sin6_addr);
e51060f0
SH		 695}
696
697static inline int cma_any_addr(struct sockaddr *addr)
698{
699 return cma_zero_addr(addr) || cma_loopback_addr(addr);
700}
701
43b752da
HS		 702static int cma_addr_cmp(struct sockaddr *src, struct sockaddr *dst)
703{
704 if (src->sa_family != dst->sa_family)
705 return -1;
706
707 switch (src->sa_family) {
708 case AF_INET:
709 return ((struct sockaddr_in *) src)->sin_addr.s_addr !=
710 ((struct sockaddr_in *) dst)->sin_addr.s_addr;
711 default:
712 return ipv6_addr_cmp(&((struct sockaddr_in6 *) src)->sin6_addr,
713 &((struct sockaddr_in6 *) dst)->sin6_addr);
714 }
715}
716
628e5f6d
SH		 717static inline __be16 cma_port(struct sockaddr *addr)
718{
719 if (addr->sa_family == AF_INET)
720 return ((struct sockaddr_in *) addr)->sin_port;
721 else
722 return ((struct sockaddr_in6 *) addr)->sin6_port;
723}
724
e51060f0
SH		 725static inline int cma_any_port(struct sockaddr *addr)
726{
628e5f6d 727 return !cma_port(addr);
e51060f0
SH		 728}
729
730static int cma_get_net_info(void *hdr, enum rdma_port_space ps,
1b90c137 731 u8 *ip_ver, __be16 *port,
e51060f0
SH		 732 union cma_ip_addr **src, union cma_ip_addr **dst)
733{
734 switch (ps) {
735 case RDMA_PS_SDP:
736 if (sdp_get_majv(((struct sdp_hh *) hdr)->sdp_version) !=
737 SDP_MAJ_VERSION)
738 return -EINVAL;
739
740 *ip_ver = sdp_get_ip_ver(hdr);
741 *port = ((struct sdp_hh *) hdr)->port;
742 *src = &((struct sdp_hh *) hdr)->src_addr;
743 *dst = &((struct sdp_hh *) hdr)->dst_addr;
744 break;
745 default:
746 if (((struct cma_hdr *) hdr)->cma_version != CMA_VERSION)
747 return -EINVAL;
748
749 *ip_ver = cma_get_ip_ver(hdr);
750 *port = ((struct cma_hdr *) hdr)->port;
751 *src = &((struct cma_hdr *) hdr)->src_addr;
752 *dst = &((struct cma_hdr *) hdr)->dst_addr;
753 break;
754 }
755
756 if (*ip_ver != 4 && *ip_ver != 6)
757 return -EINVAL;
758 return 0;
759}
760
761static void cma_save_net_info(struct rdma_addr *addr,
762 struct rdma_addr *listen_addr,
1b90c137 763 u8 ip_ver, __be16 port,
e51060f0
SH		 764 union cma_ip_addr *src, union cma_ip_addr *dst)
765{
766 struct sockaddr_in *listen4, *ip4;
767 struct sockaddr_in6 *listen6, *ip6;
768
769 switch (ip_ver) {
770 case 4:
771 listen4 = (struct sockaddr_in *) &listen_addr->src_addr;
772 ip4 = (struct sockaddr_in *) &addr->src_addr;
773 ip4->sin_family = listen4->sin_family;
774 ip4->sin_addr.s_addr = dst->ip4.addr;
775 ip4->sin_port = listen4->sin_port;
776
777 ip4 = (struct sockaddr_in *) &addr->dst_addr;
778 ip4->sin_family = listen4->sin_family;
779 ip4->sin_addr.s_addr = src->ip4.addr;
780 ip4->sin_port = port;
781 break;
782 case 6:
783 listen6 = (struct sockaddr_in6 *) &listen_addr->src_addr;
784 ip6 = (struct sockaddr_in6 *) &addr->src_addr;
785 ip6->sin6_family = listen6->sin6_family;
786 ip6->sin6_addr = dst->ip6;
787 ip6->sin6_port = listen6->sin6_port;
788
789 ip6 = (struct sockaddr_in6 *) &addr->dst_addr;
790 ip6->sin6_family = listen6->sin6_family;
791 ip6->sin6_addr = src->ip6;
792 ip6->sin6_port = port;
793 break;
794 default:
795 break;
796 }
797}
798
799static inline int cma_user_data_offset(enum rdma_port_space ps)
800{
801 switch (ps) {
802 case RDMA_PS_SDP:
803 return 0;
804 default:
805 return sizeof(struct cma_hdr);
806 }
807}
808
e51060f0
SH		 809static void cma_cancel_route(struct rdma_id_private *id_priv)
810{
3c86aa70
EC		 811 switch (rdma_port_get_link_layer(id_priv->id.device, id_priv->id.port_num)) {
812 case IB_LINK_LAYER_INFINIBAND:
e51060f0
SH		 813 if (id_priv->query)
814 ib_sa_cancel_query(id_priv->query_id, id_priv->query);
815 break;
816 default:
817 break;
818 }
819}
820
e51060f0
SH		 821static void cma_cancel_listens(struct rdma_id_private *id_priv)
822{
823 struct rdma_id_private *dev_id_priv;
824
d02d1f53
SH		 825 /*
826 * Remove from listen_any_list to prevent added devices from spawning
827 * additional listen requests.
828 */
e51060f0
SH		 829 mutex_lock(&lock);
830 list_del(&id_priv->list);
831
832 while (!list_empty(&id_priv->listen_list)) {
833 dev_id_priv = list_entry(id_priv->listen_list.next,
834 struct rdma_id_private, listen_list);
d02d1f53
SH		 835 /* sync with device removal to avoid duplicate destruction */
836 list_del_init(&dev_id_priv->list);
837 list_del(&dev_id_priv->listen_list);
838 mutex_unlock(&lock);
839
840 rdma_destroy_id(&dev_id_priv->id);
841 mutex_lock(&lock);
e51060f0
SH		 842 }
843 mutex_unlock(&lock);
844}
845
846static void cma_cancel_operation(struct rdma_id_private *id_priv,
550e5ca7 847 enum rdma_cm_state state)
e51060f0
SH		 848{
849 switch (state) {
550e5ca7 850 case RDMA_CM_ADDR_QUERY:
e51060f0
SH		 851 rdma_addr_cancel(&id_priv->id.route.addr.dev_addr);
852 break;
550e5ca7 853 case RDMA_CM_ROUTE_QUERY:
e51060f0
SH		 854 cma_cancel_route(id_priv);
855 break;
550e5ca7 856 case RDMA_CM_LISTEN:
3f446754
RD		 857 if (cma_any_addr((struct sockaddr *) &id_priv->id.route.addr.src_addr)
858 && !id_priv->cma_dev)
e51060f0
SH		 859 cma_cancel_listens(id_priv);
860 break;
861 default:
862 break;
863 }
864}
865
866static void cma_release_port(struct rdma_id_private *id_priv)
867{
868 struct rdma_bind_list *bind_list = id_priv->bind_list;
869
870 if (!bind_list)
871 return;
872
873 mutex_lock(&lock);
874 hlist_del(&id_priv->node);
875 if (hlist_empty(&bind_list->owners)) {
876 idr_remove(bind_list->ps, bind_list->port);
877 kfree(bind_list);
878 }
879 mutex_unlock(&lock);
880}
881
c8f6a362
SH		 882static void cma_leave_mc_groups(struct rdma_id_private *id_priv)
883{
884 struct cma_multicast *mc;
885
886 while (!list_empty(&id_priv->mc_list)) {
887 mc = container_of(id_priv->mc_list.next,
888 struct cma_multicast, list);
889 list_del(&mc->list);
3c86aa70
EC		 890 switch (rdma_port_get_link_layer(id_priv->cma_dev->device, id_priv->id.port_num)) {
891 case IB_LINK_LAYER_INFINIBAND:
892 ib_sa_free_multicast(mc->multicast.ib);
893 kfree(mc);
894 break;
895 case IB_LINK_LAYER_ETHERNET:
896 kref_put(&mc->mcref, release_mc);
897 break;
898 default:
899 break;
900 }
c8f6a362
SH		 901 }
902}
903
e51060f0
SH		 904void rdma_destroy_id(struct rdma_cm_id *id)
905{
906 struct rdma_id_private *id_priv;
550e5ca7 907 enum rdma_cm_state state;
e51060f0
SH		 908
909 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7 910 state = cma_exch(id_priv, RDMA_CM_DESTROYING);
e51060f0
SH		 911 cma_cancel_operation(id_priv, state);
912
a396d43a
SH		 913 /*
914 * Wait for any active callback to finish. New callbacks will find
915 * the id_priv state set to destroying and abort.
916 */
917 mutex_lock(&id_priv->handler_mutex);
918 mutex_unlock(&id_priv->handler_mutex);
919
e51060f0 920 if (id_priv->cma_dev) {
3c86aa70 921 switch (rdma_node_get_transport(id_priv->id.device->node_type)) {
07ebafba 922 case RDMA_TRANSPORT_IB:
3cd96564 923 if (id_priv->cm_id.ib && !IS_ERR(id_priv->cm_id.ib))
e51060f0
SH		 924 ib_destroy_cm_id(id_priv->cm_id.ib);
925 break;
07ebafba
TT		 926 case RDMA_TRANSPORT_IWARP:
927 if (id_priv->cm_id.iw && !IS_ERR(id_priv->cm_id.iw))
928 iw_destroy_cm_id(id_priv->cm_id.iw);
929 break;
e51060f0
SH		 930 default:
931 break;
932 }
c8f6a362 933 cma_leave_mc_groups(id_priv);
a396d43a 934 cma_release_dev(id_priv);
e51060f0
SH		 935 }
936
937 cma_release_port(id_priv);
938 cma_deref_id(id_priv);
939 wait_for_completion(&id_priv->comp);
940
d02d1f53
SH		 941 if (id_priv->internal_id)
942 cma_deref_id(id_priv->id.context);
943
e51060f0
SH		 944 kfree(id_priv->id.route.path_rec);
945 kfree(id_priv);
946}
947EXPORT_SYMBOL(rdma_destroy_id);
948
949static int cma_rep_recv(struct rdma_id_private *id_priv)
950{
951 int ret;
952
5851bb89 953 ret = cma_modify_qp_rtr(id_priv, NULL);
e51060f0
SH		 954 if (ret)
955 goto reject;
956
5851bb89 957 ret = cma_modify_qp_rts(id_priv, NULL);
e51060f0
SH		 958 if (ret)
959 goto reject;
960
961 ret = ib_send_cm_rtu(id_priv->cm_id.ib, NULL, 0);
962 if (ret)
963 goto reject;
964
965 return 0;
966reject:
c5483388 967 cma_modify_qp_err(id_priv);
e51060f0
SH		 968 ib_send_cm_rej(id_priv->cm_id.ib, IB_CM_REJ_CONSUMER_DEFINED,
969 NULL, 0, NULL, 0);
970 return ret;
971}
972
973static int cma_verify_rep(struct rdma_id_private *id_priv, void *data)
974{
975 if (id_priv->id.ps == RDMA_PS_SDP &&
976 sdp_get_majv(((struct sdp_hah *) data)->sdp_version) !=
977 SDP_MAJ_VERSION)
978 return -EINVAL;
979
980 return 0;
981}
982
a1b1b61f
SH		 983static void cma_set_rep_event_data(struct rdma_cm_event *event,
984 struct ib_cm_rep_event_param *rep_data,
985 void *private_data)
986{
987 event->param.conn.private_data = private_data;
988 event->param.conn.private_data_len = IB_CM_REP_PRIVATE_DATA_SIZE;
989 event->param.conn.responder_resources = rep_data->responder_resources;
990 event->param.conn.initiator_depth = rep_data->initiator_depth;
991 event->param.conn.flow_control = rep_data->flow_control;
992 event->param.conn.rnr_retry_count = rep_data->rnr_retry_count;
993 event->param.conn.srq = rep_data->srq;
994 event->param.conn.qp_num = rep_data->remote_qpn;
995}
996
e51060f0
SH		 997static int cma_ib_handler(struct ib_cm_id *cm_id, struct ib_cm_event *ib_event)
998{
999 struct rdma_id_private *id_priv = cm_id->context;
a1b1b61f
SH		 1000 struct rdma_cm_event event;
1001 int ret = 0;
e51060f0 1002
38ca83a5 1003 if ((ib_event->event != IB_CM_TIMEWAIT_EXIT &&
550e5ca7 1004 cma_disable_callback(id_priv, RDMA_CM_CONNECT)) ||
38ca83a5 1005 (ib_event->event == IB_CM_TIMEWAIT_EXIT &&
550e5ca7 1006 cma_disable_callback(id_priv, RDMA_CM_DISCONNECT)))
8aa08602 1007 return 0;
e51060f0 1008
a1b1b61f 1009 memset(&event, 0, sizeof event);
e51060f0
SH		 1010 switch (ib_event->event) {
1011 case IB_CM_REQ_ERROR:
1012 case IB_CM_REP_ERROR:
a1b1b61f
SH		 1013 event.event = RDMA_CM_EVENT_UNREACHABLE;
1014 event.status = -ETIMEDOUT;
e51060f0
SH		 1015 break;
1016 case IB_CM_REP_RECEIVED:
a1b1b61f
SH		 1017 event.status = cma_verify_rep(id_priv, ib_event->private_data);
1018 if (event.status)
1019 event.event = RDMA_CM_EVENT_CONNECT_ERROR;
e51060f0 1020 else if (id_priv->id.qp && id_priv->id.ps != RDMA_PS_SDP) {
a1b1b61f
SH		 1021 event.status = cma_rep_recv(id_priv);
1022 event.event = event.status ? RDMA_CM_EVENT_CONNECT_ERROR :
1023 RDMA_CM_EVENT_ESTABLISHED;
e51060f0 1024 } else
a1b1b61f
SH		 1025 event.event = RDMA_CM_EVENT_CONNECT_RESPONSE;
1026 cma_set_rep_event_data(&event, &ib_event->param.rep_rcvd,
1027 ib_event->private_data);
e51060f0
SH		 1028 break;
1029 case IB_CM_RTU_RECEIVED:
0fe313b0
SH		 1030 case IB_CM_USER_ESTABLISHED:
1031 event.event = RDMA_CM_EVENT_ESTABLISHED;
e51060f0
SH		 1032 break;
1033 case IB_CM_DREQ_ERROR:
a1b1b61f 1034 event.status = -ETIMEDOUT; /* fall through */
e51060f0
SH		 1035 case IB_CM_DREQ_RECEIVED:
1036 case IB_CM_DREP_RECEIVED:
550e5ca7
NM		 1037 if (!cma_comp_exch(id_priv, RDMA_CM_CONNECT,
1038 RDMA_CM_DISCONNECT))
e51060f0 1039 goto out;
a1b1b61f 1040 event.event = RDMA_CM_EVENT_DISCONNECTED;
e51060f0
SH		 1041 break;
1042 case IB_CM_TIMEWAIT_EXIT:
38ca83a5
AV		 1043 event.event = RDMA_CM_EVENT_TIMEWAIT_EXIT;
1044 break;
e51060f0
SH		 1045 case IB_CM_MRA_RECEIVED:
1046 /* ignore event */
1047 goto out;
1048 case IB_CM_REJ_RECEIVED:
c5483388 1049 cma_modify_qp_err(id_priv);
a1b1b61f
SH		 1050 event.status = ib_event->param.rej_rcvd.reason;
1051 event.event = RDMA_CM_EVENT_REJECTED;
1052 event.param.conn.private_data = ib_event->private_data;
1053 event.param.conn.private_data_len = IB_CM_REJ_PRIVATE_DATA_SIZE;
e51060f0
SH		 1054 break;
1055 default:
468f2239 1056 printk(KERN_ERR "RDMA CMA: unexpected IB CM event: %d\n",
e51060f0
SH		 1057 ib_event->event);
1058 goto out;
1059 }
1060
a1b1b61f 1061 ret = id_priv->id.event_handler(&id_priv->id, &event);
e51060f0
SH		 1062 if (ret) {
1063 /* Destroy the CM ID by returning a non-zero value. */
1064 id_priv->cm_id.ib = NULL;
550e5ca7 1065 cma_exch(id_priv, RDMA_CM_DESTROYING);
de910bd9 1066 mutex_unlock(&id_priv->handler_mutex);
e51060f0
SH		 1067 rdma_destroy_id(&id_priv->id);
1068 return ret;
1069 }
1070out:
de910bd9 1071 mutex_unlock(&id_priv->handler_mutex);
e51060f0
SH		 1072 return ret;
1073}
1074
628e5f6d
SH		 1075static struct rdma_id_private *cma_new_conn_id(struct rdma_cm_id *listen_id,
1076 struct ib_cm_event *ib_event)
e51060f0
SH		 1077{
1078 struct rdma_id_private *id_priv;
1079 struct rdma_cm_id *id;
1080 struct rdma_route *rt;
1081 union cma_ip_addr *src, *dst;
1b90c137 1082 __be16 port;
e51060f0 1083 u8 ip_ver;
64c5e613 1084 int ret;
e51060f0 1085
3f168d2b
KK		 1086 if (cma_get_net_info(ib_event->private_data, listen_id->ps,
1087 &ip_ver, &port, &src, &dst))
1088 goto err;
1089
e51060f0 1090 id = rdma_create_id(listen_id->event_handler, listen_id->context,
b26f9b99 1091 listen_id->ps, ib_event->param.req_rcvd.qp_type);
e51060f0 1092 if (IS_ERR(id))
3f168d2b
KK		 1093 goto err;
1094
1095 cma_save_net_info(&id->route.addr, &listen_id->route.addr,
1096 ip_ver, port, src, dst);
e51060f0
SH		 1097
1098 rt = &id->route;
1099 rt->num_paths = ib_event->param.req_rcvd.alternate_path ? 2 : 1;
3f168d2b
KK		 1100 rt->path_rec = kmalloc(sizeof *rt->path_rec * rt->num_paths,
1101 GFP_KERNEL);
e51060f0 1102 if (!rt->path_rec)
3f168d2b 1103 goto destroy_id;
e51060f0 1104
e51060f0
SH		 1105 rt->path_rec[0] = *ib_event->param.req_rcvd.primary_path;
1106 if (rt->num_paths == 2)
1107 rt->path_rec[1] = *ib_event->param.req_rcvd.alternate_path;
1108
6f8372b6
SH		 1109 if (cma_any_addr((struct sockaddr *) &rt->addr.src_addr)) {
1110 rt->addr.dev_addr.dev_type = ARPHRD_INFINIBAND;
1111 rdma_addr_set_sgid(&rt->addr.dev_addr, &rt->path_rec[0].sgid);
1112 ib_addr_set_pkey(&rt->addr.dev_addr, rt->path_rec[0].pkey);
1113 } else {
1114 ret = rdma_translate_ip((struct sockaddr *) &rt->addr.src_addr,
1115 &rt->addr.dev_addr);
1116 if (ret)
1117 goto destroy_id;
1118 }
1119 rdma_addr_set_dgid(&rt->addr.dev_addr, &rt->path_rec[0].dgid);
e51060f0
SH		 1120
1121 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7 1122 id_priv->state = RDMA_CM_CONNECT;
e51060f0 1123 return id_priv;
3f168d2b
KK		 1124
1125destroy_id:
e51060f0 1126 rdma_destroy_id(id);
3f168d2b 1127err:
e51060f0
SH		 1128 return NULL;
1129}
1130
628e5f6d
SH		 1131static struct rdma_id_private *cma_new_udp_id(struct rdma_cm_id *listen_id,
1132 struct ib_cm_event *ib_event)
1133{
1134 struct rdma_id_private *id_priv;
1135 struct rdma_cm_id *id;
1136 union cma_ip_addr *src, *dst;
1b90c137 1137 __be16 port;
628e5f6d
SH		 1138 u8 ip_ver;
1139 int ret;
1140
1141 id = rdma_create_id(listen_id->event_handler, listen_id->context,
b26f9b99 1142 listen_id->ps, IB_QPT_UD);
628e5f6d
SH		 1143 if (IS_ERR(id))
1144 return NULL;
1145
1146
1147 if (cma_get_net_info(ib_event->private_data, listen_id->ps,
1148 &ip_ver, &port, &src, &dst))
1149 goto err;
1150
1151 cma_save_net_info(&id->route.addr, &listen_id->route.addr,
1152 ip_ver, port, src, dst);
1153
6f8372b6
SH		 1154 if (!cma_any_addr((struct sockaddr *) &id->route.addr.src_addr)) {
1155 ret = rdma_translate_ip((struct sockaddr *) &id->route.addr.src_addr,
1156 &id->route.addr.dev_addr);
1157 if (ret)
1158 goto err;
1159 }
628e5f6d
SH		 1160
1161 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7 1162 id_priv->state = RDMA_CM_CONNECT;
628e5f6d
SH		 1163 return id_priv;
1164err:
1165 rdma_destroy_id(id);
1166 return NULL;
1167}
1168
a1b1b61f
SH		 1169static void cma_set_req_event_data(struct rdma_cm_event *event,
1170 struct ib_cm_req_event_param *req_data,
1171 void *private_data, int offset)
1172{
1173 event->param.conn.private_data = private_data + offset;
1174 event->param.conn.private_data_len = IB_CM_REQ_PRIVATE_DATA_SIZE - offset;
1175 event->param.conn.responder_resources = req_data->responder_resources;
1176 event->param.conn.initiator_depth = req_data->initiator_depth;
1177 event->param.conn.flow_control = req_data->flow_control;
1178 event->param.conn.retry_count = req_data->retry_count;
1179 event->param.conn.rnr_retry_count = req_data->rnr_retry_count;
1180 event->param.conn.srq = req_data->srq;
1181 event->param.conn.qp_num = req_data->remote_qpn;
1182}
1183
e51060f0
SH		 1184static int cma_req_handler(struct ib_cm_id *cm_id, struct ib_cm_event *ib_event)
1185{
1186 struct rdma_id_private *listen_id, *conn_id;
a1b1b61f 1187 struct rdma_cm_event event;
e51060f0
SH		 1188 int offset, ret;
1189
1190 listen_id = cm_id->context;
550e5ca7 1191 if (cma_disable_callback(listen_id, RDMA_CM_LISTEN))
8aa08602 1192 return -ECONNABORTED;
e51060f0 1193
628e5f6d
SH		 1194 memset(&event, 0, sizeof event);
1195 offset = cma_user_data_offset(listen_id->id.ps);
1196 event.event = RDMA_CM_EVENT_CONNECT_REQUEST;
b26f9b99 1197 if (listen_id->id.qp_type == IB_QPT_UD) {
628e5f6d
SH		 1198 conn_id = cma_new_udp_id(&listen_id->id, ib_event);
1199 event.param.ud.private_data = ib_event->private_data + offset;
1200 event.param.ud.private_data_len =
1201 IB_CM_SIDR_REQ_PRIVATE_DATA_SIZE - offset;
1202 } else {
1203 conn_id = cma_new_conn_id(&listen_id->id, ib_event);
1204 cma_set_req_event_data(&event, &ib_event->param.req_rcvd,
1205 ib_event->private_data, offset);
1206 }
e51060f0
SH		 1207 if (!conn_id) {
1208 ret = -ENOMEM;
1209 goto out;
1210 }
1211
de910bd9 1212 mutex_lock_nested(&conn_id->handler_mutex, SINGLE_DEPTH_NESTING);
07ebafba 1213 ret = cma_acquire_dev(conn_id);
a1a733f6
KK		 1214 if (ret)
1215 goto release_conn_id;
e51060f0
SH		 1216
1217 conn_id->cm_id.ib = cm_id;
1218 cm_id->context = conn_id;
1219 cm_id->cm_handler = cma_ib_handler;
1220
25ae21a1
SH		 1221 /*
1222 * Protect against the user destroying conn_id from another thread
1223 * until we're done accessing it.
1224 */
1225 atomic_inc(&conn_id->refcount);
a1b1b61f 1226 ret = conn_id->id.event_handler(&conn_id->id, &event);
45d9478d 1227 if (!ret) {
ead595ae
SH		 1228 /*
1229 * Acquire mutex to prevent user executing rdma_destroy_id()
1230 * while we're accessing the cm_id.
1231 */
1232 mutex_lock(&lock);
b26f9b99 1233 if (cma_comp(conn_id, RDMA_CM_CONNECT) && (conn_id->id.qp_type != IB_QPT_UD))
ead595ae
SH		 1234 ib_send_cm_mra(cm_id, CMA_CM_MRA_SETTING, NULL, 0);
1235 mutex_unlock(&lock);
de910bd9 1236 mutex_unlock(&conn_id->handler_mutex);
25ae21a1 1237 cma_deref_id(conn_id);
a1a733f6 1238 goto out;
45d9478d 1239 }
25ae21a1 1240 cma_deref_id(conn_id);
a1a733f6
KK		 1241
1242 /* Destroy the CM ID by returning a non-zero value. */
1243 conn_id->cm_id.ib = NULL;
1244
1245release_conn_id:
550e5ca7 1246 cma_exch(conn_id, RDMA_CM_DESTROYING);
de910bd9 1247 mutex_unlock(&conn_id->handler_mutex);
a1a733f6
KK		 1248 rdma_destroy_id(&conn_id->id);
1249
e51060f0 1250out:
de910bd9 1251 mutex_unlock(&listen_id->handler_mutex);
e51060f0
SH		 1252 return ret;
1253}
1254
1255static __be64 cma_get_service_id(enum rdma_port_space ps, struct sockaddr *addr)
1256{
628e5f6d 1257 return cpu_to_be64(((u64)ps << 16) + be16_to_cpu(cma_port(addr)));
e51060f0
SH		 1258}
1259
1260static void cma_set_compare_data(enum rdma_port_space ps, struct sockaddr *addr,
1261 struct ib_cm_compare_data *compare)
1262{
1263 struct cma_hdr *cma_data, *cma_mask;
1264 struct sdp_hh *sdp_data, *sdp_mask;
1b90c137 1265 __be32 ip4_addr;
e51060f0
SH		 1266 struct in6_addr ip6_addr;
1267
1268 memset(compare, 0, sizeof *compare);
1269 cma_data = (void *) compare->data;
1270 cma_mask = (void *) compare->mask;
1271 sdp_data = (void *) compare->data;
1272 sdp_mask = (void *) compare->mask;
1273
1274 switch (addr->sa_family) {
1275 case AF_INET:
1276 ip4_addr = ((struct sockaddr_in *) addr)->sin_addr.s_addr;
1277 if (ps == RDMA_PS_SDP) {
1278 sdp_set_ip_ver(sdp_data, 4);
1279 sdp_set_ip_ver(sdp_mask, 0xF);
1280 sdp_data->dst_addr.ip4.addr = ip4_addr;
1b90c137 1281 sdp_mask->dst_addr.ip4.addr = htonl(~0);
e51060f0
SH		 1282 } else {
1283 cma_set_ip_ver(cma_data, 4);
1284 cma_set_ip_ver(cma_mask, 0xF);
1285 cma_data->dst_addr.ip4.addr = ip4_addr;
1b90c137 1286 cma_mask->dst_addr.ip4.addr = htonl(~0);
e51060f0
SH		 1287 }
1288 break;
1289 case AF_INET6:
1290 ip6_addr = ((struct sockaddr_in6 *) addr)->sin6_addr;
1291 if (ps == RDMA_PS_SDP) {
1292 sdp_set_ip_ver(sdp_data, 6);
1293 sdp_set_ip_ver(sdp_mask, 0xF);
1294 sdp_data->dst_addr.ip6 = ip6_addr;
1295 memset(&sdp_mask->dst_addr.ip6, 0xFF,
1296 sizeof sdp_mask->dst_addr.ip6);
1297 } else {
1298 cma_set_ip_ver(cma_data, 6);
1299 cma_set_ip_ver(cma_mask, 0xF);
1300 cma_data->dst_addr.ip6 = ip6_addr;
1301 memset(&cma_mask->dst_addr.ip6, 0xFF,
1302 sizeof cma_mask->dst_addr.ip6);
1303 }
1304 break;
1305 default:
1306 break;
1307 }
1308}
1309
07ebafba
TT		 1310static int cma_iw_handler(struct iw_cm_id *iw_id, struct iw_cm_event *iw_event)
1311{
1312 struct rdma_id_private *id_priv = iw_id->context;
a1b1b61f 1313 struct rdma_cm_event event;
07ebafba
TT		 1314 struct sockaddr_in *sin;
1315 int ret = 0;
1316
550e5ca7 1317 if (cma_disable_callback(id_priv, RDMA_CM_CONNECT))
be65f086 1318 return 0;
07ebafba 1319
be65f086 1320 memset(&event, 0, sizeof event);
07ebafba
TT		 1321 switch (iw_event->event) {
1322 case IW_CM_EVENT_CLOSE:
a1b1b61f 1323 event.event = RDMA_CM_EVENT_DISCONNECTED;
07ebafba
TT		 1324 break;
1325 case IW_CM_EVENT_CONNECT_REPLY:
1326 sin = (struct sockaddr_in *) &id_priv->id.route.addr.src_addr;
1327 *sin = iw_event->local_addr;
1328 sin = (struct sockaddr_in *) &id_priv->id.route.addr.dst_addr;
1329 *sin = iw_event->remote_addr;
881a045f
SW		 1330 switch (iw_event->status) {
1331 case 0:
a1b1b61f 1332 event.event = RDMA_CM_EVENT_ESTABLISHED;
881a045f
SW		 1333 break;
1334 case -ECONNRESET:
1335 case -ECONNREFUSED:
1336 event.event = RDMA_CM_EVENT_REJECTED;
1337 break;
1338 case -ETIMEDOUT:
1339 event.event = RDMA_CM_EVENT_UNREACHABLE;
1340 break;
1341 default:
1342 event.event = RDMA_CM_EVENT_CONNECT_ERROR;
1343 break;
1344 }
07ebafba
TT		 1345 break;
1346 case IW_CM_EVENT_ESTABLISHED:
a1b1b61f 1347 event.event = RDMA_CM_EVENT_ESTABLISHED;
07ebafba
TT		 1348 break;
1349 default:
1350 BUG_ON(1);
1351 }
1352
a1b1b61f
SH		 1353 event.status = iw_event->status;
1354 event.param.conn.private_data = iw_event->private_data;
1355 event.param.conn.private_data_len = iw_event->private_data_len;
1356 ret = id_priv->id.event_handler(&id_priv->id, &event);
07ebafba
TT		 1357 if (ret) {
1358 /* Destroy the CM ID by returning a non-zero value. */
1359 id_priv->cm_id.iw = NULL;
550e5ca7 1360 cma_exch(id_priv, RDMA_CM_DESTROYING);
de910bd9 1361 mutex_unlock(&id_priv->handler_mutex);
07ebafba
TT		 1362 rdma_destroy_id(&id_priv->id);
1363 return ret;
1364 }
1365
de910bd9 1366 mutex_unlock(&id_priv->handler_mutex);
07ebafba
TT		 1367 return ret;
1368}
1369
1370static int iw_conn_req_handler(struct iw_cm_id *cm_id,
1371 struct iw_cm_event *iw_event)
1372{
1373 struct rdma_cm_id *new_cm_id;
1374 struct rdma_id_private *listen_id, *conn_id;
1375 struct sockaddr_in *sin;
1376 struct net_device *dev = NULL;
a1b1b61f 1377 struct rdma_cm_event event;
07ebafba 1378 int ret;
8d8293cf 1379 struct ib_device_attr attr;
07ebafba
TT		 1380
1381 listen_id = cm_id->context;
550e5ca7 1382 if (cma_disable_callback(listen_id, RDMA_CM_LISTEN))
8aa08602 1383 return -ECONNABORTED;
07ebafba
TT		 1384
1385 /* Create a new RDMA id for the new IW CM ID */
1386 new_cm_id = rdma_create_id(listen_id->id.event_handler,
1387 listen_id->id.context,
b26f9b99 1388 RDMA_PS_TCP, IB_QPT_RC);
10f32065 1389 if (IS_ERR(new_cm_id)) {
07ebafba
TT		 1390 ret = -ENOMEM;
1391 goto out;
1392 }
1393 conn_id = container_of(new_cm_id, struct rdma_id_private, id);
de910bd9 1394 mutex_lock_nested(&conn_id->handler_mutex, SINGLE_DEPTH_NESTING);
550e5ca7 1395 conn_id->state = RDMA_CM_CONNECT;
07ebafba 1396
1ab35276 1397 dev = ip_dev_find(&init_net, iw_event->local_addr.sin_addr.s_addr);
07ebafba
TT		 1398 if (!dev) {
1399 ret = -EADDRNOTAVAIL;
de910bd9 1400 mutex_unlock(&conn_id->handler_mutex);
07ebafba
TT		 1401 rdma_destroy_id(new_cm_id);
1402 goto out;
1403 }
1404 ret = rdma_copy_addr(&conn_id->id.route.addr.dev_addr, dev, NULL);
1405 if (ret) {
de910bd9 1406 mutex_unlock(&conn_id->handler_mutex);
07ebafba
TT		 1407 rdma_destroy_id(new_cm_id);
1408 goto out;
1409 }
1410
1411 ret = cma_acquire_dev(conn_id);
1412 if (ret) {
de910bd9 1413 mutex_unlock(&conn_id->handler_mutex);
07ebafba
TT		 1414 rdma_destroy_id(new_cm_id);
1415 goto out;
1416 }
1417
1418 conn_id->cm_id.iw = cm_id;
1419 cm_id->context = conn_id;
1420 cm_id->cm_handler = cma_iw_handler;
1421
1422 sin = (struct sockaddr_in *) &new_cm_id->route.addr.src_addr;
1423 *sin = iw_event->local_addr;
1424 sin = (struct sockaddr_in *) &new_cm_id->route.addr.dst_addr;
1425 *sin = iw_event->remote_addr;
1426
8d8293cf
SW		 1427 ret = ib_query_device(conn_id->id.device, &attr);
1428 if (ret) {
de910bd9 1429 mutex_unlock(&conn_id->handler_mutex);
8d8293cf
SW		 1430 rdma_destroy_id(new_cm_id);
1431 goto out;
1432 }
1433
a1b1b61f
SH		 1434 memset(&event, 0, sizeof event);
1435 event.event = RDMA_CM_EVENT_CONNECT_REQUEST;
1436 event.param.conn.private_data = iw_event->private_data;
1437 event.param.conn.private_data_len = iw_event->private_data_len;
8d8293cf
SW		 1438 event.param.conn.initiator_depth = attr.max_qp_init_rd_atom;
1439 event.param.conn.responder_resources = attr.max_qp_rd_atom;
25ae21a1
SH		 1440
1441 /*
1442 * Protect against the user destroying conn_id from another thread
1443 * until we're done accessing it.
1444 */
1445 atomic_inc(&conn_id->refcount);
a1b1b61f 1446 ret = conn_id->id.event_handler(&conn_id->id, &event);
07ebafba
TT		 1447 if (ret) {
1448 /* User wants to destroy the CM ID */
1449 conn_id->cm_id.iw = NULL;
550e5ca7 1450 cma_exch(conn_id, RDMA_CM_DESTROYING);
de910bd9 1451 mutex_unlock(&conn_id->handler_mutex);
25ae21a1 1452 cma_deref_id(conn_id);
07ebafba 1453 rdma_destroy_id(&conn_id->id);
de910bd9 1454 goto out;
07ebafba
TT		 1455 }
1456
de910bd9 1457 mutex_unlock(&conn_id->handler_mutex);
25ae21a1 1458 cma_deref_id(conn_id);
de910bd9 1459
07ebafba
TT		 1460out:
1461 if (dev)
1462 dev_put(dev);
de910bd9 1463 mutex_unlock(&listen_id->handler_mutex);
07ebafba
TT		 1464 return ret;
1465}
1466
e51060f0
SH		 1467static int cma_ib_listen(struct rdma_id_private *id_priv)
1468{
1469 struct ib_cm_compare_data compare_data;
1470 struct sockaddr *addr;
1471 __be64 svc_id;
1472 int ret;
1473
1474 id_priv->cm_id.ib = ib_create_cm_id(id_priv->id.device, cma_req_handler,
1475 id_priv);
1476 if (IS_ERR(id_priv->cm_id.ib))
1477 return PTR_ERR(id_priv->cm_id.ib);
1478
3f446754 1479 addr = (struct sockaddr *) &id_priv->id.route.addr.src_addr;
e51060f0
SH		 1480 svc_id = cma_get_service_id(id_priv->id.ps, addr);
1481 if (cma_any_addr(addr))
1482 ret = ib_cm_listen(id_priv->cm_id.ib, svc_id, 0, NULL);
1483 else {
1484 cma_set_compare_data(id_priv->id.ps, addr, &compare_data);
1485 ret = ib_cm_listen(id_priv->cm_id.ib, svc_id, 0, &compare_data);
1486 }
1487
1488 if (ret) {
1489 ib_destroy_cm_id(id_priv->cm_id.ib);
1490 id_priv->cm_id.ib = NULL;
1491 }
1492
1493 return ret;
1494}
1495
07ebafba
TT		 1496static int cma_iw_listen(struct rdma_id_private *id_priv, int backlog)
1497{
1498 int ret;
1499 struct sockaddr_in *sin;
1500
1501 id_priv->cm_id.iw = iw_create_cm_id(id_priv->id.device,
1502 iw_conn_req_handler,
1503 id_priv);
1504 if (IS_ERR(id_priv->cm_id.iw))
1505 return PTR_ERR(id_priv->cm_id.iw);
1506
1507 sin = (struct sockaddr_in *) &id_priv->id.route.addr.src_addr;
1508 id_priv->cm_id.iw->local_addr = *sin;
1509
1510 ret = iw_cm_listen(id_priv->cm_id.iw, backlog);
1511
1512 if (ret) {
1513 iw_destroy_cm_id(id_priv->cm_id.iw);
1514 id_priv->cm_id.iw = NULL;
1515 }
1516
1517 return ret;
1518}
1519
e51060f0
SH		 1520static int cma_listen_handler(struct rdma_cm_id *id,
1521 struct rdma_cm_event *event)
1522{
1523 struct rdma_id_private *id_priv = id->context;
1524
1525 id->context = id_priv->id.context;
1526 id->event_handler = id_priv->id.event_handler;
1527 return id_priv->id.event_handler(id, event);
1528}
1529
1530static void cma_listen_on_dev(struct rdma_id_private *id_priv,
1531 struct cma_device *cma_dev)
1532{
1533 struct rdma_id_private *dev_id_priv;
1534 struct rdma_cm_id *id;
1535 int ret;
1536
b26f9b99
SH		 1537 id = rdma_create_id(cma_listen_handler, id_priv, id_priv->id.ps,
1538 id_priv->id.qp_type);
e51060f0
SH		 1539 if (IS_ERR(id))
1540 return;
1541
1542 dev_id_priv = container_of(id, struct rdma_id_private, id);
1543
550e5ca7 1544 dev_id_priv->state = RDMA_CM_ADDR_BOUND;
e51060f0 1545 memcpy(&id->route.addr.src_addr, &id_priv->id.route.addr.src_addr,
3f446754 1546 ip_addr_size((struct sockaddr *) &id_priv->id.route.addr.src_addr));
e51060f0
SH		 1547
1548 cma_attach_to_dev(dev_id_priv, cma_dev);
1549 list_add_tail(&dev_id_priv->listen_list, &id_priv->listen_list);
d02d1f53
SH		 1550 atomic_inc(&id_priv->refcount);
1551 dev_id_priv->internal_id = 1;
e51060f0
SH		 1552
1553 ret = rdma_listen(id, id_priv->backlog);
1554 if (ret)
d02d1f53 1555 printk(KERN_WARNING "RDMA CMA: cma_listen_on_dev, error %d, "
468f2239 1556 "listening on device %s\n", ret, cma_dev->device->name);
e51060f0
SH		 1557}
1558
1559static void cma_listen_on_all(struct rdma_id_private *id_priv)
1560{
1561 struct cma_device *cma_dev;
1562
1563 mutex_lock(&lock);
1564 list_add_tail(&id_priv->list, &listen_any_list);
1565 list_for_each_entry(cma_dev, &dev_list, list)
1566 cma_listen_on_dev(id_priv, cma_dev);
1567 mutex_unlock(&lock);
1568}
1569
a81c994d
SH		 1570void rdma_set_service_type(struct rdma_cm_id *id, int tos)
1571{
1572 struct rdma_id_private *id_priv;
1573
1574 id_priv = container_of(id, struct rdma_id_private, id);
1575 id_priv->tos = (u8) tos;
1576}
1577EXPORT_SYMBOL(rdma_set_service_type);
1578
e51060f0
SH		 1579static void cma_query_handler(int status, struct ib_sa_path_rec *path_rec,
1580 void *context)
1581{
1582 struct cma_work *work = context;
1583 struct rdma_route *route;
1584
1585 route = &work->id->id.route;
1586
1587 if (!status) {
1588 route->num_paths = 1;
1589 *route->path_rec = *path_rec;
1590 } else {
550e5ca7
NM		 1591 work->old_state = RDMA_CM_ROUTE_QUERY;
1592 work->new_state = RDMA_CM_ADDR_RESOLVED;
e51060f0 1593 work->event.event = RDMA_CM_EVENT_ROUTE_ERROR;
8f0472d3 1594 work->event.status = status;
e51060f0
SH		 1595 }
1596
1597 queue_work(cma_wq, &work->work);
1598}
1599
1600static int cma_query_ib_route(struct rdma_id_private *id_priv, int timeout_ms,
1601 struct cma_work *work)
1602{
a81c994d 1603 struct rdma_addr *addr = &id_priv->id.route.addr;
e51060f0 1604 struct ib_sa_path_rec path_rec;
a81c994d
SH		 1605 ib_sa_comp_mask comp_mask;
1606 struct sockaddr_in6 *sin6;
e51060f0
SH		 1607
1608 memset(&path_rec, 0, sizeof path_rec);
6f8372b6
SH		 1609 rdma_addr_get_sgid(&addr->dev_addr, &path_rec.sgid);
1610 rdma_addr_get_dgid(&addr->dev_addr, &path_rec.dgid);
a81c994d 1611 path_rec.pkey = cpu_to_be16(ib_addr_get_pkey(&addr->dev_addr));
e51060f0 1612 path_rec.numb_path = 1;
962063e6 1613 path_rec.reversible = 1;
3f446754
RD		 1614 path_rec.service_id = cma_get_service_id(id_priv->id.ps,
1615 (struct sockaddr *) &addr->dst_addr);
a81c994d
SH		 1616
1617 comp_mask = IB_SA_PATH_REC_DGID | IB_SA_PATH_REC_SGID |
1618 IB_SA_PATH_REC_PKEY | IB_SA_PATH_REC_NUMB_PATH |
1619 IB_SA_PATH_REC_REVERSIBLE | IB_SA_PATH_REC_SERVICE_ID;
1620
3f446754 1621 if (addr->src_addr.ss_family == AF_INET) {
a81c994d
SH		 1622 path_rec.qos_class = cpu_to_be16((u16) id_priv->tos);
1623 comp_mask |= IB_SA_PATH_REC_QOS_CLASS;
1624 } else {
1625 sin6 = (struct sockaddr_in6 *) &addr->src_addr;
1626 path_rec.traffic_class = (u8) (be32_to_cpu(sin6->sin6_flowinfo) >> 20);
1627 comp_mask |= IB_SA_PATH_REC_TRAFFIC_CLASS;
1628 }
e51060f0 1629
c1a0b23b 1630 id_priv->query_id = ib_sa_path_rec_get(&sa_client, id_priv->id.device,
a81c994d
SH		 1631 id_priv->id.port_num, &path_rec,
1632 comp_mask, timeout_ms,
1633 GFP_KERNEL, cma_query_handler,
1634 work, &id_priv->query);
e51060f0
SH		 1635
1636 return (id_priv->query_id < 0) ? id_priv->query_id : 0;
1637}
1638
c4028958 1639static void cma_work_handler(struct work_struct *_work)
e51060f0 1640{
c4028958 1641 struct cma_work *work = container_of(_work, struct cma_work, work);
e51060f0
SH		 1642 struct rdma_id_private *id_priv = work->id;
1643 int destroy = 0;
1644
de910bd9 1645 mutex_lock(&id_priv->handler_mutex);
e51060f0
SH		 1646 if (!cma_comp_exch(id_priv, work->old_state, work->new_state))
1647 goto out;
1648
1649 if (id_priv->id.event_handler(&id_priv->id, &work->event)) {
550e5ca7 1650 cma_exch(id_priv, RDMA_CM_DESTROYING);
e51060f0
SH		 1651 destroy = 1;
1652 }
1653out:
de910bd9 1654 mutex_unlock(&id_priv->handler_mutex);
e51060f0
SH		 1655 cma_deref_id(id_priv);
1656 if (destroy)
1657 rdma_destroy_id(&id_priv->id);
1658 kfree(work);
1659}
1660
dd5bdff8
OG		 1661static void cma_ndev_work_handler(struct work_struct *_work)
1662{
1663 struct cma_ndev_work *work = container_of(_work, struct cma_ndev_work, work);
1664 struct rdma_id_private *id_priv = work->id;
1665 int destroy = 0;
1666
1667 mutex_lock(&id_priv->handler_mutex);
550e5ca7
NM		 1668 if (id_priv->state == RDMA_CM_DESTROYING ||
1669 id_priv->state == RDMA_CM_DEVICE_REMOVAL)
dd5bdff8
OG		 1670 goto out;
1671
1672 if (id_priv->id.event_handler(&id_priv->id, &work->event)) {
550e5ca7 1673 cma_exch(id_priv, RDMA_CM_DESTROYING);
dd5bdff8
OG		 1674 destroy = 1;
1675 }
1676
1677out:
1678 mutex_unlock(&id_priv->handler_mutex);
1679 cma_deref_id(id_priv);
1680 if (destroy)
1681 rdma_destroy_id(&id_priv->id);
1682 kfree(work);
1683}
1684
e51060f0
SH		 1685static int cma_resolve_ib_route(struct rdma_id_private *id_priv, int timeout_ms)
1686{
1687 struct rdma_route *route = &id_priv->id.route;
1688 struct cma_work *work;
1689 int ret;
1690
1691 work = kzalloc(sizeof *work, GFP_KERNEL);
1692 if (!work)
1693 return -ENOMEM;
1694
1695 work->id = id_priv;
c4028958 1696 INIT_WORK(&work->work, cma_work_handler);
550e5ca7
NM		 1697 work->old_state = RDMA_CM_ROUTE_QUERY;
1698 work->new_state = RDMA_CM_ROUTE_RESOLVED;
e51060f0
SH		 1699 work->event.event = RDMA_CM_EVENT_ROUTE_RESOLVED;
1700
1701 route->path_rec = kmalloc(sizeof *route->path_rec, GFP_KERNEL);
1702 if (!route->path_rec) {
1703 ret = -ENOMEM;
1704 goto err1;
1705 }
1706
1707 ret = cma_query_ib_route(id_priv, timeout_ms, work);
1708 if (ret)
1709 goto err2;
1710
1711 return 0;
1712err2:
1713 kfree(route->path_rec);
1714 route->path_rec = NULL;
1715err1:
1716 kfree(work);
1717 return ret;
1718}
1719
1720int rdma_set_ib_paths(struct rdma_cm_id *id,
1721 struct ib_sa_path_rec *path_rec, int num_paths)
1722{
1723 struct rdma_id_private *id_priv;
1724 int ret;
1725
1726 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7
NM		 1727 if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_RESOLVED,
1728 RDMA_CM_ROUTE_RESOLVED))
e51060f0
SH		 1729 return -EINVAL;
1730
9893e742
JL		 1731 id->route.path_rec = kmemdup(path_rec, sizeof *path_rec * num_paths,
1732 GFP_KERNEL);
e51060f0
SH		 1733 if (!id->route.path_rec) {
1734 ret = -ENOMEM;
1735 goto err;
1736 }
1737
ae2d9293 1738 id->route.num_paths = num_paths;
e51060f0
SH		 1739 return 0;
1740err:
550e5ca7 1741 cma_comp_exch(id_priv, RDMA_CM_ROUTE_RESOLVED, RDMA_CM_ADDR_RESOLVED);
e51060f0
SH		 1742 return ret;
1743}
1744EXPORT_SYMBOL(rdma_set_ib_paths);
1745
07ebafba
TT		 1746static int cma_resolve_iw_route(struct rdma_id_private *id_priv, int timeout_ms)
1747{
1748 struct cma_work *work;
1749
1750 work = kzalloc(sizeof *work, GFP_KERNEL);
1751 if (!work)
1752 return -ENOMEM;
1753
1754 work->id = id_priv;
c4028958 1755 INIT_WORK(&work->work, cma_work_handler);
550e5ca7
NM		 1756 work->old_state = RDMA_CM_ROUTE_QUERY;
1757 work->new_state = RDMA_CM_ROUTE_RESOLVED;
07ebafba
TT		 1758 work->event.event = RDMA_CM_EVENT_ROUTE_RESOLVED;
1759 queue_work(cma_wq, &work->work);
1760 return 0;
1761}
1762
3c86aa70
EC		 1763static int cma_resolve_iboe_route(struct rdma_id_private *id_priv)
1764{
1765 struct rdma_route *route = &id_priv->id.route;
1766 struct rdma_addr *addr = &route->addr;
1767 struct cma_work *work;
1768 int ret;
1769 struct sockaddr_in *src_addr = (struct sockaddr_in *)&route->addr.src_addr;
1770 struct sockaddr_in *dst_addr = (struct sockaddr_in *)&route->addr.dst_addr;
1771 struct net_device *ndev = NULL;
af7bd463 1772 u16 vid;
3c86aa70
EC		 1773
1774 if (src_addr->sin_family != dst_addr->sin_family)
1775 return -EINVAL;
1776
1777 work = kzalloc(sizeof *work, GFP_KERNEL);
1778 if (!work)
1779 return -ENOMEM;
1780
1781 work->id = id_priv;
1782 INIT_WORK(&work->work, cma_work_handler);
1783
1784 route->path_rec = kzalloc(sizeof *route->path_rec, GFP_KERNEL);
1785 if (!route->path_rec) {
1786 ret = -ENOMEM;
1787 goto err1;
1788 }
1789
1790 route->num_paths = 1;
1791
3c86aa70
EC		 1792 if (addr->dev_addr.bound_dev_if)
1793 ndev = dev_get_by_index(&init_net, addr->dev_addr.bound_dev_if);
1794 if (!ndev) {
1795 ret = -ENODEV;
1796 goto err2;
1797 }
1798
af7bd463
EC		 1799 vid = rdma_vlan_dev_vlan_id(ndev);
1800
1801 iboe_mac_vlan_to_ll(&route->path_rec->sgid, addr->dev_addr.src_dev_addr, vid);
1802 iboe_mac_vlan_to_ll(&route->path_rec->dgid, addr->dev_addr.dst_dev_addr, vid);
1803
1804 route->path_rec->hop_limit = 1;
1805 route->path_rec->reversible = 1;
1806 route->path_rec->pkey = cpu_to_be16(0xffff);
1807 route->path_rec->mtu_selector = IB_SA_EQ;
1808 route->path_rec->sl = id_priv->tos >> 5;
1809
3c86aa70
EC		 1810 route->path_rec->mtu = iboe_get_mtu(ndev->mtu);
1811 route->path_rec->rate_selector = IB_SA_EQ;
1812 route->path_rec->rate = iboe_get_rate(ndev);
1813 dev_put(ndev);
1814 route->path_rec->packet_life_time_selector = IB_SA_EQ;
1815 route->path_rec->packet_life_time = CMA_IBOE_PACKET_LIFETIME;
1816 if (!route->path_rec->mtu) {
1817 ret = -EINVAL;
1818 goto err2;
1819 }
1820
550e5ca7
NM		 1821 work->old_state = RDMA_CM_ROUTE_QUERY;
1822 work->new_state = RDMA_CM_ROUTE_RESOLVED;
3c86aa70
EC		 1823 work->event.event = RDMA_CM_EVENT_ROUTE_RESOLVED;
1824 work->event.status = 0;
1825
1826 queue_work(cma_wq, &work->work);
1827
1828 return 0;
1829
1830err2:
1831 kfree(route->path_rec);
1832 route->path_rec = NULL;
1833err1:
1834 kfree(work);
1835 return ret;
1836}
1837
e51060f0
SH		 1838int rdma_resolve_route(struct rdma_cm_id *id, int timeout_ms)
1839{
1840 struct rdma_id_private *id_priv;
1841 int ret;
1842
1843 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7 1844 if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_RESOLVED, RDMA_CM_ROUTE_QUERY))
e51060f0
SH		 1845 return -EINVAL;
1846
1847 atomic_inc(&id_priv->refcount);
07ebafba
TT		 1848 switch (rdma_node_get_transport(id->device->node_type)) {
1849 case RDMA_TRANSPORT_IB:
3c86aa70
EC		 1850 switch (rdma_port_get_link_layer(id->device, id->port_num)) {
1851 case IB_LINK_LAYER_INFINIBAND:
1852 ret = cma_resolve_ib_route(id_priv, timeout_ms);
1853 break;
1854 case IB_LINK_LAYER_ETHERNET:
1855 ret = cma_resolve_iboe_route(id_priv);
1856 break;
1857 default:
1858 ret = -ENOSYS;
1859 }
e51060f0 1860 break;
07ebafba
TT		 1861 case RDMA_TRANSPORT_IWARP:
1862 ret = cma_resolve_iw_route(id_priv, timeout_ms);
1863 break;
e51060f0
SH		 1864 default:
1865 ret = -ENOSYS;
1866 break;
1867 }
1868 if (ret)
1869 goto err;
1870
1871 return 0;
1872err:
550e5ca7 1873 cma_comp_exch(id_priv, RDMA_CM_ROUTE_QUERY, RDMA_CM_ADDR_RESOLVED);
e51060f0
SH		 1874 cma_deref_id(id_priv);
1875 return ret;
1876}
1877EXPORT_SYMBOL(rdma_resolve_route);
1878
1879static int cma_bind_loopback(struct rdma_id_private *id_priv)
1880{
1881 struct cma_device *cma_dev;
1882 struct ib_port_attr port_attr;
f0ee3404 1883 union ib_gid gid;
e51060f0
SH		 1884 u16 pkey;
1885 int ret;
1886 u8 p;
1887
1888 mutex_lock(&lock);
e82153b5
KK		 1889 if (list_empty(&dev_list)) {
1890 ret = -ENODEV;
1891 goto out;
1892 }
e51060f0
SH		 1893 list_for_each_entry(cma_dev, &dev_list, list)
1894 for (p = 1; p <= cma_dev->device->phys_port_cnt; ++p)
e82153b5 1895 if (!ib_query_port(cma_dev->device, p, &port_attr) &&
e51060f0
SH		 1896 port_attr.state == IB_PORT_ACTIVE)
1897 goto port_found;
1898
e82153b5
KK		 1899 p = 1;
1900 cma_dev = list_entry(dev_list.next, struct cma_device, list);
e51060f0
SH		 1901
1902port_found:
f0ee3404 1903 ret = ib_get_cached_gid(cma_dev->device, p, 0, &gid);
e51060f0
SH		 1904 if (ret)
1905 goto out;
1906
1907 ret = ib_get_cached_pkey(cma_dev->device, p, 0, &pkey);
1908 if (ret)
1909 goto out;
1910
6f8372b6 1911 id_priv->id.route.addr.dev_addr.dev_type =
3c86aa70 1912 (rdma_port_get_link_layer(cma_dev->device, p) == IB_LINK_LAYER_INFINIBAND) ?
6f8372b6
SH		 1913 ARPHRD_INFINIBAND : ARPHRD_ETHER;
1914
1915 rdma_addr_set_sgid(&id_priv->id.route.addr.dev_addr, &gid);
e51060f0
SH		 1916 ib_addr_set_pkey(&id_priv->id.route.addr.dev_addr, pkey);
1917 id_priv->id.port_num = p;
1918 cma_attach_to_dev(id_priv, cma_dev);
1919out:
1920 mutex_unlock(&lock);
1921 return ret;
1922}
1923
1924static void addr_handler(int status, struct sockaddr *src_addr,
1925 struct rdma_dev_addr *dev_addr, void *context)
1926{
1927 struct rdma_id_private *id_priv = context;
a1b1b61f 1928 struct rdma_cm_event event;
e51060f0 1929
a1b1b61f 1930 memset(&event, 0, sizeof event);
de910bd9 1931 mutex_lock(&id_priv->handler_mutex);
550e5ca7
NM		 1932 if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_QUERY,
1933 RDMA_CM_ADDR_RESOLVED))
61a73c70 1934 goto out;
61a73c70
SH		 1935
1936 if (!status && !id_priv->cma_dev)
e51060f0
SH		 1937 status = cma_acquire_dev(id_priv);
1938
1939 if (status) {
550e5ca7
NM		 1940 if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_RESOLVED,
1941 RDMA_CM_ADDR_BOUND))
e51060f0 1942 goto out;
a1b1b61f
SH		 1943 event.event = RDMA_CM_EVENT_ADDR_ERROR;
1944 event.status = status;
e51060f0 1945 } else {
e51060f0
SH		 1946 memcpy(&id_priv->id.route.addr.src_addr, src_addr,
1947 ip_addr_size(src_addr));
a1b1b61f 1948 event.event = RDMA_CM_EVENT_ADDR_RESOLVED;
e51060f0
SH		 1949 }
1950
a1b1b61f 1951 if (id_priv->id.event_handler(&id_priv->id, &event)) {
550e5ca7 1952 cma_exch(id_priv, RDMA_CM_DESTROYING);
de910bd9 1953 mutex_unlock(&id_priv->handler_mutex);
e51060f0
SH		 1954 cma_deref_id(id_priv);
1955 rdma_destroy_id(&id_priv->id);
1956 return;
1957 }
1958out:
de910bd9 1959 mutex_unlock(&id_priv->handler_mutex);
e51060f0
SH		 1960 cma_deref_id(id_priv);
1961}
1962
1963static int cma_resolve_loopback(struct rdma_id_private *id_priv)
1964{
1965 struct cma_work *work;
6f8372b6 1966 struct sockaddr *src, *dst;
f0ee3404 1967 union ib_gid gid;
e51060f0
SH		 1968 int ret;
1969
1970 work = kzalloc(sizeof *work, GFP_KERNEL);
1971 if (!work)
1972 return -ENOMEM;
1973
1974 if (!id_priv->cma_dev) {
1975 ret = cma_bind_loopback(id_priv);
1976 if (ret)
1977 goto err;
1978 }
1979
6f8372b6
SH		 1980 rdma_addr_get_sgid(&id_priv->id.route.addr.dev_addr, &gid);
1981 rdma_addr_set_dgid(&id_priv->id.route.addr.dev_addr, &gid);
e51060f0 1982
6f8372b6
SH		 1983 src = (struct sockaddr *) &id_priv->id.route.addr.src_addr;
1984 if (cma_zero_addr(src)) {
1985 dst = (struct sockaddr *) &id_priv->id.route.addr.dst_addr;
1986 if ((src->sa_family = dst->sa_family) == AF_INET) {
1987 ((struct sockaddr_in *) src)->sin_addr.s_addr =
1988 ((struct sockaddr_in *) dst)->sin_addr.s_addr;
1989 } else {
1990 ipv6_addr_copy(&((struct sockaddr_in6 *) src)->sin6_addr,
1991 &((struct sockaddr_in6 *) dst)->sin6_addr);
1992 }
e51060f0
SH		 1993 }
1994
1995 work->id = id_priv;
c4028958 1996 INIT_WORK(&work->work, cma_work_handler);
550e5ca7
NM		 1997 work->old_state = RDMA_CM_ADDR_QUERY;
1998 work->new_state = RDMA_CM_ADDR_RESOLVED;
e51060f0
SH		 1999 work->event.event = RDMA_CM_EVENT_ADDR_RESOLVED;
2000 queue_work(cma_wq, &work->work);
2001 return 0;
2002err:
2003 kfree(work);
2004 return ret;
2005}
2006
2007static int cma_bind_addr(struct rdma_cm_id *id, struct sockaddr *src_addr,
2008 struct sockaddr *dst_addr)
2009{
d14714df
SH		 2010 if (!src_addr || !src_addr->sa_family) {
2011 src_addr = (struct sockaddr *) &id->route.addr.src_addr;
2012 if ((src_addr->sa_family = dst_addr->sa_family) == AF_INET6) {
2013 ((struct sockaddr_in6 *) src_addr)->sin6_scope_id =
2014 ((struct sockaddr_in6 *) dst_addr)->sin6_scope_id;
2015 }
2016 }
2017 return rdma_bind_addr(id, src_addr);
e51060f0
SH		 2018}
2019
2020int rdma_resolve_addr(struct rdma_cm_id *id, struct sockaddr *src_addr,
2021 struct sockaddr *dst_addr, int timeout_ms)
2022{
2023 struct rdma_id_private *id_priv;
2024 int ret;
2025
2026 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7 2027 if (id_priv->state == RDMA_CM_IDLE) {
e51060f0
SH		 2028 ret = cma_bind_addr(id, src_addr, dst_addr);
2029 if (ret)
2030 return ret;
2031 }
2032
550e5ca7 2033 if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_BOUND, RDMA_CM_ADDR_QUERY))
e51060f0
SH		 2034 return -EINVAL;
2035
2036 atomic_inc(&id_priv->refcount);
2037 memcpy(&id->route.addr.dst_addr, dst_addr, ip_addr_size(dst_addr));
2038 if (cma_any_addr(dst_addr))
2039 ret = cma_resolve_loopback(id_priv);
2040 else
3f446754 2041 ret = rdma_resolve_ip(&addr_client, (struct sockaddr *) &id->route.addr.src_addr,
7a118df3 2042 dst_addr, &id->route.addr.dev_addr,
e51060f0
SH		 2043 timeout_ms, addr_handler, id_priv);
2044 if (ret)
2045 goto err;
2046
2047 return 0;
2048err:
550e5ca7 2049 cma_comp_exch(id_priv, RDMA_CM_ADDR_QUERY, RDMA_CM_ADDR_BOUND);
e51060f0
SH		 2050 cma_deref_id(id_priv);
2051 return ret;
2052}
2053EXPORT_SYMBOL(rdma_resolve_addr);
2054
a9bb7912
HS		 2055int rdma_set_reuseaddr(struct rdma_cm_id *id, int reuse)
2056{
2057 struct rdma_id_private *id_priv;
2058 unsigned long flags;
2059 int ret;
2060
2061 id_priv = container_of(id, struct rdma_id_private, id);
2062 spin_lock_irqsave(&id_priv->lock, flags);
550e5ca7 2063 if (id_priv->state == RDMA_CM_IDLE) {
a9bb7912
HS		 2064 id_priv->reuseaddr = reuse;
2065 ret = 0;
2066 } else {
2067 ret = -EINVAL;
2068 }
2069 spin_unlock_irqrestore(&id_priv->lock, flags);
2070 return ret;
2071}
2072EXPORT_SYMBOL(rdma_set_reuseaddr);
2073
e51060f0
SH		 2074static void cma_bind_port(struct rdma_bind_list *bind_list,
2075 struct rdma_id_private *id_priv)
2076{
2077 struct sockaddr_in *sin;
2078
2079 sin = (struct sockaddr_in *) &id_priv->id.route.addr.src_addr;
2080 sin->sin_port = htons(bind_list->port);
2081 id_priv->bind_list = bind_list;
2082 hlist_add_head(&id_priv->node, &bind_list->owners);
2083}
2084
2085static int cma_alloc_port(struct idr *ps, struct rdma_id_private *id_priv,
2086 unsigned short snum)
2087{
2088 struct rdma_bind_list *bind_list;
aedec080 2089 int port, ret;
e51060f0 2090
cb164b8c 2091 bind_list = kzalloc(sizeof *bind_list, GFP_KERNEL);
e51060f0
SH		 2092 if (!bind_list)
2093 return -ENOMEM;
2094
aedec080
SH		 2095 do {
2096 ret = idr_get_new_above(ps, bind_list, snum, &port);
2097 } while ((ret == -EAGAIN) && idr_pre_get(ps, GFP_KERNEL));
2098
2099 if (ret)
2100 goto err1;
2101
2102 if (port != snum) {
2103 ret = -EADDRNOTAVAIL;
2104 goto err2;
2105 }
2106
2107 bind_list->ps = ps;
2108 bind_list->port = (unsigned short) port;
2109 cma_bind_port(bind_list, id_priv);
2110 return 0;
2111err2:
2112 idr_remove(ps, port);
2113err1:
2114 kfree(bind_list);
2115 return ret;
2116}
e51060f0 2117
aedec080
SH		 2118static int cma_alloc_any_port(struct idr *ps, struct rdma_id_private *id_priv)
2119{
5d7220e8
TH		 2120 static unsigned int last_used_port;
2121 int low, high, remaining;
2122 unsigned int rover;
e51060f0 2123
227b60f5 2124 inet_get_local_port_range(&low, &high);
5d7220e8
TH		 2125 remaining = (high - low) + 1;
2126 rover = net_random() % remaining + low;
2127retry:
2128 if (last_used_port != rover &&
2129 !idr_find(ps, (unsigned short) rover)) {
2130 int ret = cma_alloc_port(ps, id_priv, rover);
2131 /*
2132 * Remember previously used port number in order to avoid
2133 * re-using same port immediately after it is closed.
2134 */
2135 if (!ret)
2136 last_used_port = rover;
2137 if (ret != -EADDRNOTAVAIL)
2138 return ret;
e51060f0 2139 }
5d7220e8
TH		 2140 if (--remaining) {
2141 rover++;
2142 if ((rover < low) || (rover > high))
2143 rover = low;
2144 goto retry;
2145 }
2146 return -EADDRNOTAVAIL;
e51060f0
SH		 2147}
2148
a9bb7912
HS		 2149/*
2150 * Check that the requested port is available. This is called when trying to
2151 * bind to a specific port, or when trying to listen on a bound port. In
2152 * the latter case, the provided id_priv may already be on the bind_list, but
2153 * we still need to check that it's okay to start listening.
2154 */
2155static int cma_check_port(struct rdma_bind_list *bind_list,
2156 struct rdma_id_private *id_priv, uint8_t reuseaddr)
e51060f0
SH		 2157{
2158 struct rdma_id_private *cur_id;
43b752da 2159 struct sockaddr *addr, *cur_addr;
e51060f0 2160 struct hlist_node *node;
e51060f0 2161
43b752da 2162 addr = (struct sockaddr *) &id_priv->id.route.addr.src_addr;
a9bb7912 2163 if (cma_any_addr(addr) && !reuseaddr)
e51060f0
SH		 2164 return -EADDRNOTAVAIL;
2165
2166 hlist_for_each_entry(cur_id, node, &bind_list->owners, node) {
a9bb7912
HS		 2167 if (id_priv == cur_id)
2168 continue;
3cd96564 2169
550e5ca7 2170 if ((cur_id->state == RDMA_CM_LISTEN) ||
a9bb7912
HS		 2171 !reuseaddr || !cur_id->reuseaddr) {
2172 cur_addr = (struct sockaddr *) &cur_id->id.route.addr.src_addr;
2173 if (cma_any_addr(cur_addr))
2174 return -EADDRNOTAVAIL;
e51060f0 2175
a9bb7912
HS		 2176 if (!cma_addr_cmp(addr, cur_addr))
2177 return -EADDRINUSE;
2178 }
2179 }
e51060f0
SH		 2180 return 0;
2181}
2182
a9bb7912
HS		 2183static int cma_use_port(struct idr *ps, struct rdma_id_private *id_priv)
2184{
2185 struct rdma_bind_list *bind_list;
2186 unsigned short snum;
2187 int ret;
2188
2189 snum = ntohs(cma_port((struct sockaddr *) &id_priv->id.route.addr.src_addr));
2190 if (snum < PROT_SOCK && !capable(CAP_NET_BIND_SERVICE))
2191 return -EACCES;
2192
2193 bind_list = idr_find(ps, snum);
2194 if (!bind_list) {
2195 ret = cma_alloc_port(ps, id_priv, snum);
2196 } else {
2197 ret = cma_check_port(bind_list, id_priv, id_priv->reuseaddr);
2198 if (!ret)
2199 cma_bind_port(bind_list, id_priv);
2200 }
2201 return ret;
2202}
2203
2204static int cma_bind_listen(struct rdma_id_private *id_priv)
2205{
2206 struct rdma_bind_list *bind_list = id_priv->bind_list;
2207 int ret = 0;
2208
2209 mutex_lock(&lock);
2210 if (bind_list->owners.first->next)
2211 ret = cma_check_port(bind_list, id_priv, 0);
2212 mutex_unlock(&lock);
2213 return ret;
2214}
2215
e51060f0
SH		 2216static int cma_get_port(struct rdma_id_private *id_priv)
2217{
2218 struct idr *ps;
2219 int ret;
2220
2221 switch (id_priv->id.ps) {
2222 case RDMA_PS_SDP:
2223 ps = &sdp_ps;
2224 break;
2225 case RDMA_PS_TCP:
2226 ps = &tcp_ps;
2227 break;
628e5f6d
SH		 2228 case RDMA_PS_UDP:
2229 ps = &udp_ps;
2230 break;
c8f6a362
SH		 2231 case RDMA_PS_IPOIB:
2232 ps = &ipoib_ps;
2233 break;
e51060f0
SH		 2234 default:
2235 return -EPROTONOSUPPORT;
2236 }
2237
2238 mutex_lock(&lock);
3f446754 2239 if (cma_any_port((struct sockaddr *) &id_priv->id.route.addr.src_addr))
aedec080 2240 ret = cma_alloc_any_port(ps, id_priv);
e51060f0
SH		 2241 else
2242 ret = cma_use_port(ps, id_priv);
2243 mutex_unlock(&lock);
2244
2245 return ret;
2246}
2247
d14714df
SH		 2248static int cma_check_linklocal(struct rdma_dev_addr *dev_addr,
2249 struct sockaddr *addr)
2250{
fd4582a3 2251#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
d14714df
SH		 2252 struct sockaddr_in6 *sin6;
2253
2254 if (addr->sa_family != AF_INET6)
2255 return 0;
2256
2257 sin6 = (struct sockaddr_in6 *) addr;
2258 if ((ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_LINKLOCAL) &&
2259 !sin6->sin6_scope_id)
2260 return -EINVAL;
2261
2262 dev_addr->bound_dev_if = sin6->sin6_scope_id;
2263#endif
2264 return 0;
2265}
2266
a9bb7912
HS		 2267int rdma_listen(struct rdma_cm_id *id, int backlog)
2268{
2269 struct rdma_id_private *id_priv;
2270 int ret;
2271
2272 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7 2273 if (id_priv->state == RDMA_CM_IDLE) {
a9bb7912
HS		 2274 ((struct sockaddr *) &id->route.addr.src_addr)->sa_family = AF_INET;
2275 ret = rdma_bind_addr(id, (struct sockaddr *) &id->route.addr.src_addr);
2276 if (ret)
2277 return ret;
2278 }
2279
550e5ca7 2280 if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_BOUND, RDMA_CM_LISTEN))
a9bb7912
HS		 2281 return -EINVAL;
2282
2283 if (id_priv->reuseaddr) {
2284 ret = cma_bind_listen(id_priv);
2285 if (ret)
2286 goto err;
2287 }
2288
2289 id_priv->backlog = backlog;
2290 if (id->device) {
2291 switch (rdma_node_get_transport(id->device->node_type)) {
2292 case RDMA_TRANSPORT_IB:
2293 ret = cma_ib_listen(id_priv);
2294 if (ret)
2295 goto err;
2296 break;
2297 case RDMA_TRANSPORT_IWARP:
2298 ret = cma_iw_listen(id_priv, backlog);
2299 if (ret)
2300 goto err;
2301 break;
2302 default:
2303 ret = -ENOSYS;
2304 goto err;
2305 }
2306 } else
2307 cma_listen_on_all(id_priv);
2308
2309 return 0;
2310err:
2311 id_priv->backlog = 0;
550e5ca7 2312 cma_comp_exch(id_priv, RDMA_CM_LISTEN, RDMA_CM_ADDR_BOUND);
a9bb7912
HS		 2313 return ret;
2314}
2315EXPORT_SYMBOL(rdma_listen);
2316
e51060f0
SH		 2317int rdma_bind_addr(struct rdma_cm_id *id, struct sockaddr *addr)
2318{
2319 struct rdma_id_private *id_priv;
2320 int ret;
2321
1f5175ad 2322 if (addr->sa_family != AF_INET && addr->sa_family != AF_INET6)
e51060f0
SH		 2323 return -EAFNOSUPPORT;
2324
2325 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7 2326 if (!cma_comp_exch(id_priv, RDMA_CM_IDLE, RDMA_CM_ADDR_BOUND))
e51060f0
SH		 2327 return -EINVAL;
2328
d14714df
SH		 2329 ret = cma_check_linklocal(&id->route.addr.dev_addr, addr);
2330 if (ret)
2331 goto err1;
2332
8523c048 2333 if (!cma_any_addr(addr)) {
e51060f0 2334 ret = rdma_translate_ip(addr, &id->route.addr.dev_addr);
e51060f0 2335 if (ret)
255d0c14
KK		 2336 goto err1;
2337
255d0c14 2338 ret = cma_acquire_dev(id_priv);
255d0c14
KK		 2339 if (ret)
2340 goto err1;
e51060f0
SH		 2341 }
2342
2343 memcpy(&id->route.addr.src_addr, addr, ip_addr_size(addr));
2344 ret = cma_get_port(id_priv);
2345 if (ret)
255d0c14 2346 goto err2;
e51060f0
SH		 2347
2348 return 0;
255d0c14 2349err2:
a396d43a
SH		 2350 if (id_priv->cma_dev)
2351 cma_release_dev(id_priv);
255d0c14 2352err1:
550e5ca7 2353 cma_comp_exch(id_priv, RDMA_CM_ADDR_BOUND, RDMA_CM_IDLE);
e51060f0
SH		 2354 return ret;
2355}
2356EXPORT_SYMBOL(rdma_bind_addr);
2357
2358static int cma_format_hdr(void *hdr, enum rdma_port_space ps,
2359 struct rdma_route *route)
2360{
e51060f0
SH		 2361 struct cma_hdr *cma_hdr;
2362 struct sdp_hh *sdp_hdr;
2363
1f5175ad
AS		 2364 if (route->addr.src_addr.ss_family == AF_INET) {
2365 struct sockaddr_in *src4, *dst4;
2366
2367 src4 = (struct sockaddr_in *) &route->addr.src_addr;
2368 dst4 = (struct sockaddr_in *) &route->addr.dst_addr;
2369
2370 switch (ps) {
2371 case RDMA_PS_SDP:
2372 sdp_hdr = hdr;
2373 if (sdp_get_majv(sdp_hdr->sdp_version) != SDP_MAJ_VERSION)
2374 return -EINVAL;
2375 sdp_set_ip_ver(sdp_hdr, 4);
2376 sdp_hdr->src_addr.ip4.addr = src4->sin_addr.s_addr;
2377 sdp_hdr->dst_addr.ip4.addr = dst4->sin_addr.s_addr;
2378 sdp_hdr->port = src4->sin_port;
2379 break;
2380 default:
2381 cma_hdr = hdr;
2382 cma_hdr->cma_version = CMA_VERSION;
2383 cma_set_ip_ver(cma_hdr, 4);
2384 cma_hdr->src_addr.ip4.addr = src4->sin_addr.s_addr;
2385 cma_hdr->dst_addr.ip4.addr = dst4->sin_addr.s_addr;
2386 cma_hdr->port = src4->sin_port;
2387 break;
2388 }
2389 } else {
2390 struct sockaddr_in6 *src6, *dst6;
2391
2392 src6 = (struct sockaddr_in6 *) &route->addr.src_addr;
2393 dst6 = (struct sockaddr_in6 *) &route->addr.dst_addr;
2394
2395 switch (ps) {
2396 case RDMA_PS_SDP:
2397 sdp_hdr = hdr;
2398 if (sdp_get_majv(sdp_hdr->sdp_version) != SDP_MAJ_VERSION)
2399 return -EINVAL;
2400 sdp_set_ip_ver(sdp_hdr, 6);
2401 sdp_hdr->src_addr.ip6 = src6->sin6_addr;
2402 sdp_hdr->dst_addr.ip6 = dst6->sin6_addr;
2403 sdp_hdr->port = src6->sin6_port;
2404 break;
2405 default:
2406 cma_hdr = hdr;
2407 cma_hdr->cma_version = CMA_VERSION;
2408 cma_set_ip_ver(cma_hdr, 6);
2409 cma_hdr->src_addr.ip6 = src6->sin6_addr;
2410 cma_hdr->dst_addr.ip6 = dst6->sin6_addr;
2411 cma_hdr->port = src6->sin6_port;
2412 break;
2413 }
e51060f0
SH		 2414 }
2415 return 0;
2416}
2417
628e5f6d
SH		 2418static int cma_sidr_rep_handler(struct ib_cm_id *cm_id,
2419 struct ib_cm_event *ib_event)
2420{
2421 struct rdma_id_private *id_priv = cm_id->context;
2422 struct rdma_cm_event event;
2423 struct ib_cm_sidr_rep_event_param *rep = &ib_event->param.sidr_rep_rcvd;
2424 int ret = 0;
2425
550e5ca7 2426 if (cma_disable_callback(id_priv, RDMA_CM_CONNECT))
8aa08602 2427 return 0;
628e5f6d 2428
8aa08602 2429 memset(&event, 0, sizeof event);
628e5f6d
SH		 2430 switch (ib_event->event) {
2431 case IB_CM_SIDR_REQ_ERROR:
2432 event.event = RDMA_CM_EVENT_UNREACHABLE;
2433 event.status = -ETIMEDOUT;
2434 break;
2435 case IB_CM_SIDR_REP_RECEIVED:
2436 event.param.ud.private_data = ib_event->private_data;
2437 event.param.ud.private_data_len = IB_CM_SIDR_REP_PRIVATE_DATA_SIZE;
2438 if (rep->status != IB_SIDR_SUCCESS) {
2439 event.event = RDMA_CM_EVENT_UNREACHABLE;
2440 event.status = ib_event->param.sidr_rep_rcvd.status;
2441 break;
2442 }
d2ca39f2
YE		 2443 ret = cma_set_qkey(id_priv);
2444 if (ret) {
2445 event.event = RDMA_CM_EVENT_ADDR_ERROR;
2446 event.status = -EINVAL;
2447 break;
2448 }
c8f6a362 2449 if (id_priv->qkey != rep->qkey) {
628e5f6d
SH		 2450 event.event = RDMA_CM_EVENT_UNREACHABLE;
2451 event.status = -EINVAL;
2452 break;
2453 }
2454 ib_init_ah_from_path(id_priv->id.device, id_priv->id.port_num,
2455 id_priv->id.route.path_rec,
2456 &event.param.ud.ah_attr);
2457 event.param.ud.qp_num = rep->qpn;
2458 event.param.ud.qkey = rep->qkey;
2459 event.event = RDMA_CM_EVENT_ESTABLISHED;
2460 event.status = 0;
2461 break;
2462 default:
468f2239 2463 printk(KERN_ERR "RDMA CMA: unexpected IB CM event: %d\n",
628e5f6d
SH		 2464 ib_event->event);
2465 goto out;
2466 }
2467
2468 ret = id_priv->id.event_handler(&id_priv->id, &event);
2469 if (ret) {
2470 /* Destroy the CM ID by returning a non-zero value. */
2471 id_priv->cm_id.ib = NULL;
550e5ca7 2472 cma_exch(id_priv, RDMA_CM_DESTROYING);
de910bd9 2473 mutex_unlock(&id_priv->handler_mutex);
628e5f6d
SH		 2474 rdma_destroy_id(&id_priv->id);
2475 return ret;
2476 }
2477out:
de910bd9 2478 mutex_unlock(&id_priv->handler_mutex);
628e5f6d
SH		 2479 return ret;
2480}
2481
2482static int cma_resolve_ib_udp(struct rdma_id_private *id_priv,
2483 struct rdma_conn_param *conn_param)
2484{
2485 struct ib_cm_sidr_req_param req;
2486 struct rdma_route *route;
2487 int ret;
2488
2489 req.private_data_len = sizeof(struct cma_hdr) +
2490 conn_param->private_data_len;
2491 req.private_data = kzalloc(req.private_data_len, GFP_ATOMIC);
2492 if (!req.private_data)
2493 return -ENOMEM;
2494
2495 if (conn_param->private_data && conn_param->private_data_len)
2496 memcpy((void *) req.private_data + sizeof(struct cma_hdr),
2497 conn_param->private_data, conn_param->private_data_len);
2498
2499 route = &id_priv->id.route;
2500 ret = cma_format_hdr((void *) req.private_data, id_priv->id.ps, route);
2501 if (ret)
2502 goto out;
2503
2504 id_priv->cm_id.ib = ib_create_cm_id(id_priv->id.device,
2505 cma_sidr_rep_handler, id_priv);
2506 if (IS_ERR(id_priv->cm_id.ib)) {
2507 ret = PTR_ERR(id_priv->cm_id.ib);
2508 goto out;
2509 }
2510
2511 req.path = route->path_rec;
2512 req.service_id = cma_get_service_id(id_priv->id.ps,
3f446754 2513 (struct sockaddr *) &route->addr.dst_addr);
628e5f6d
SH		 2514 req.timeout_ms = 1 << (CMA_CM_RESPONSE_TIMEOUT - 8);
2515 req.max_cm_retries = CMA_MAX_CM_RETRIES;
2516
2517 ret = ib_send_cm_sidr_req(id_priv->cm_id.ib, &req);
2518 if (ret) {
2519 ib_destroy_cm_id(id_priv->cm_id.ib);
2520 id_priv->cm_id.ib = NULL;
2521 }
2522out:
2523 kfree(req.private_data);
2524 return ret;
2525}
2526
e51060f0
SH		 2527static int cma_connect_ib(struct rdma_id_private *id_priv,
2528 struct rdma_conn_param *conn_param)
2529{
2530 struct ib_cm_req_param req;
2531 struct rdma_route *route;
2532 void *private_data;
2533 int offset, ret;
2534
2535 memset(&req, 0, sizeof req);
2536 offset = cma_user_data_offset(id_priv->id.ps);
2537 req.private_data_len = offset + conn_param->private_data_len;
2538 private_data = kzalloc(req.private_data_len, GFP_ATOMIC);
2539 if (!private_data)
2540 return -ENOMEM;
2541
2542 if (conn_param->private_data && conn_param->private_data_len)
2543 memcpy(private_data + offset, conn_param->private_data,
2544 conn_param->private_data_len);
2545
2546 id_priv->cm_id.ib = ib_create_cm_id(id_priv->id.device, cma_ib_handler,
2547 id_priv);
2548 if (IS_ERR(id_priv->cm_id.ib)) {
2549 ret = PTR_ERR(id_priv->cm_id.ib);
2550 goto out;
2551 }
2552
2553 route = &id_priv->id.route;
2554 ret = cma_format_hdr(private_data, id_priv->id.ps, route);
2555 if (ret)
2556 goto out;
2557 req.private_data = private_data;
2558
2559 req.primary_path = &route->path_rec[0];
2560 if (route->num_paths == 2)
2561 req.alternate_path = &route->path_rec[1];
2562
2563 req.service_id = cma_get_service_id(id_priv->id.ps,
3f446754 2564 (struct sockaddr *) &route->addr.dst_addr);
e51060f0 2565 req.qp_num = id_priv->qp_num;
9b2e9c0c 2566 req.qp_type = IB_QPT_RC;
e51060f0
SH		 2567 req.starting_psn = id_priv->seq_num;
2568 req.responder_resources = conn_param->responder_resources;
2569 req.initiator_depth = conn_param->initiator_depth;
2570 req.flow_control = conn_param->flow_control;
2571 req.retry_count = conn_param->retry_count;
2572 req.rnr_retry_count = conn_param->rnr_retry_count;
2573 req.remote_cm_response_timeout = CMA_CM_RESPONSE_TIMEOUT;
2574 req.local_cm_response_timeout = CMA_CM_RESPONSE_TIMEOUT;
2575 req.max_cm_retries = CMA_MAX_CM_RETRIES;
2576 req.srq = id_priv->srq ? 1 : 0;
2577
2578 ret = ib_send_cm_req(id_priv->cm_id.ib, &req);
2579out:
675a027c
KK		 2580 if (ret && !IS_ERR(id_priv->cm_id.ib)) {
2581 ib_destroy_cm_id(id_priv->cm_id.ib);
2582 id_priv->cm_id.ib = NULL;
2583 }
2584
e51060f0
SH		 2585 kfree(private_data);
2586 return ret;
2587}
2588
07ebafba
TT		 2589static int cma_connect_iw(struct rdma_id_private *id_priv,
2590 struct rdma_conn_param *conn_param)
2591{
2592 struct iw_cm_id *cm_id;
2593 struct sockaddr_in* sin;
2594 int ret;
2595 struct iw_cm_conn_param iw_param;
2596
2597 cm_id = iw_create_cm_id(id_priv->id.device, cma_iw_handler, id_priv);
2598 if (IS_ERR(cm_id)) {
2599 ret = PTR_ERR(cm_id);
2600 goto out;
2601 }
2602
2603 id_priv->cm_id.iw = cm_id;
2604
2605 sin = (struct sockaddr_in*) &id_priv->id.route.addr.src_addr;
2606 cm_id->local_addr = *sin;
2607
2608 sin = (struct sockaddr_in*) &id_priv->id.route.addr.dst_addr;
2609 cm_id->remote_addr = *sin;
2610
5851bb89 2611 ret = cma_modify_qp_rtr(id_priv, conn_param);
675a027c
KK		 2612 if (ret)
2613 goto out;
07ebafba
TT		 2614
2615 iw_param.ord = conn_param->initiator_depth;
2616 iw_param.ird = conn_param->responder_resources;
2617 iw_param.private_data = conn_param->private_data;
2618 iw_param.private_data_len = conn_param->private_data_len;
2619 if (id_priv->id.qp)
2620 iw_param.qpn = id_priv->qp_num;
2621 else
2622 iw_param.qpn = conn_param->qp_num;
2623 ret = iw_cm_connect(cm_id, &iw_param);
2624out:
675a027c
KK		 2625 if (ret && !IS_ERR(cm_id)) {
2626 iw_destroy_cm_id(cm_id);
2627 id_priv->cm_id.iw = NULL;
2628 }
07ebafba
TT		 2629 return ret;
2630}
2631
e51060f0
SH		 2632int rdma_connect(struct rdma_cm_id *id, struct rdma_conn_param *conn_param)
2633{
2634 struct rdma_id_private *id_priv;
2635 int ret;
2636
2637 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7 2638 if (!cma_comp_exch(id_priv, RDMA_CM_ROUTE_RESOLVED, RDMA_CM_CONNECT))
e51060f0
SH		 2639 return -EINVAL;
2640
2641 if (!id->qp) {
2642 id_priv->qp_num = conn_param->qp_num;
e51060f0
SH		 2643 id_priv->srq = conn_param->srq;
2644 }
2645
07ebafba
TT		 2646 switch (rdma_node_get_transport(id->device->node_type)) {
2647 case RDMA_TRANSPORT_IB:
b26f9b99 2648 if (id->qp_type == IB_QPT_UD)
628e5f6d
SH		 2649 ret = cma_resolve_ib_udp(id_priv, conn_param);
2650 else
2651 ret = cma_connect_ib(id_priv, conn_param);
e51060f0 2652 break;
07ebafba
TT		 2653 case RDMA_TRANSPORT_IWARP:
2654 ret = cma_connect_iw(id_priv, conn_param);
2655 break;
e51060f0
SH		 2656 default:
2657 ret = -ENOSYS;
2658 break;
2659 }
2660 if (ret)
2661 goto err;
2662
2663 return 0;
2664err:
550e5ca7 2665 cma_comp_exch(id_priv, RDMA_CM_CONNECT, RDMA_CM_ROUTE_RESOLVED);
e51060f0
SH		 2666 return ret;
2667}
2668EXPORT_SYMBOL(rdma_connect);
2669
2670static int cma_accept_ib(struct rdma_id_private *id_priv,
2671 struct rdma_conn_param *conn_param)
2672{
2673 struct ib_cm_rep_param rep;
5851bb89 2674 int ret;
0fe313b0 2675
5851bb89
SH		 2676 ret = cma_modify_qp_rtr(id_priv, conn_param);
2677 if (ret)
2678 goto out;
0fe313b0 2679
5851bb89
SH		 2680 ret = cma_modify_qp_rts(id_priv, conn_param);
2681 if (ret)
2682 goto out;
e51060f0
SH		 2683
2684 memset(&rep, 0, sizeof rep);
2685 rep.qp_num = id_priv->qp_num;
2686 rep.starting_psn = id_priv->seq_num;
2687 rep.private_data = conn_param->private_data;
2688 rep.private_data_len = conn_param->private_data_len;
2689 rep.responder_resources = conn_param->responder_resources;
2690 rep.initiator_depth = conn_param->initiator_depth;
e51060f0
SH		 2691 rep.failover_accepted = 0;
2692 rep.flow_control = conn_param->flow_control;
2693 rep.rnr_retry_count = conn_param->rnr_retry_count;
2694 rep.srq = id_priv->srq ? 1 : 0;
2695
0fe313b0
SH		 2696 ret = ib_send_cm_rep(id_priv->cm_id.ib, &rep);
2697out:
2698 return ret;
e51060f0
SH		 2699}
2700
07ebafba
TT		 2701static int cma_accept_iw(struct rdma_id_private *id_priv,
2702 struct rdma_conn_param *conn_param)
2703{
2704 struct iw_cm_conn_param iw_param;
2705 int ret;
2706
5851bb89 2707 ret = cma_modify_qp_rtr(id_priv, conn_param);
07ebafba
TT		 2708 if (ret)
2709 return ret;
2710
2711 iw_param.ord = conn_param->initiator_depth;
2712 iw_param.ird = conn_param->responder_resources;
2713 iw_param.private_data = conn_param->private_data;
2714 iw_param.private_data_len = conn_param->private_data_len;
2715 if (id_priv->id.qp) {
2716 iw_param.qpn = id_priv->qp_num;
2717 } else
2718 iw_param.qpn = conn_param->qp_num;
2719
2720 return iw_cm_accept(id_priv->cm_id.iw, &iw_param);
2721}
2722
628e5f6d
SH		 2723static int cma_send_sidr_rep(struct rdma_id_private *id_priv,
2724 enum ib_cm_sidr_status status,
2725 const void *private_data, int private_data_len)
2726{
2727 struct ib_cm_sidr_rep_param rep;
d2ca39f2 2728 int ret;
628e5f6d
SH		 2729
2730 memset(&rep, 0, sizeof rep);
2731 rep.status = status;
2732 if (status == IB_SIDR_SUCCESS) {
d2ca39f2
YE		 2733 ret = cma_set_qkey(id_priv);
2734 if (ret)
2735 return ret;
628e5f6d 2736 rep.qp_num = id_priv->qp_num;
c8f6a362 2737 rep.qkey = id_priv->qkey;
628e5f6d
SH		 2738 }
2739 rep.private_data = private_data;
2740 rep.private_data_len = private_data_len;
2741
2742 return ib_send_cm_sidr_rep(id_priv->cm_id.ib, &rep);
2743}
2744
e51060f0
SH		 2745int rdma_accept(struct rdma_cm_id *id, struct rdma_conn_param *conn_param)
2746{
2747 struct rdma_id_private *id_priv;
2748 int ret;
2749
2750 id_priv = container_of(id, struct rdma_id_private, id);
83e9502d
NM		 2751
2752 id_priv->owner = task_pid_nr(current);
2753
550e5ca7 2754 if (!cma_comp(id_priv, RDMA_CM_CONNECT))
e51060f0
SH		 2755 return -EINVAL;
2756
2757 if (!id->qp && conn_param) {
2758 id_priv->qp_num = conn_param->qp_num;
e51060f0
SH		 2759 id_priv->srq = conn_param->srq;
2760 }
2761
07ebafba
TT		 2762 switch (rdma_node_get_transport(id->device->node_type)) {
2763 case RDMA_TRANSPORT_IB:
b26f9b99 2764 if (id->qp_type == IB_QPT_UD)
628e5f6d
SH		 2765 ret = cma_send_sidr_rep(id_priv, IB_SIDR_SUCCESS,
2766 conn_param->private_data,
2767 conn_param->private_data_len);
2768 else if (conn_param)
e51060f0
SH		 2769 ret = cma_accept_ib(id_priv, conn_param);
2770 else
2771 ret = cma_rep_recv(id_priv);
2772 break;
07ebafba
TT		 2773 case RDMA_TRANSPORT_IWARP:
2774 ret = cma_accept_iw(id_priv, conn_param);
2775 break;
e51060f0
SH		 2776 default:
2777 ret = -ENOSYS;
2778 break;
2779 }
2780
2781 if (ret)
2782 goto reject;
2783
2784 return 0;
2785reject:
c5483388 2786 cma_modify_qp_err(id_priv);
e51060f0
SH		 2787 rdma_reject(id, NULL, 0);
2788 return ret;
2789}
2790EXPORT_SYMBOL(rdma_accept);
2791
0fe313b0
SH		 2792int rdma_notify(struct rdma_cm_id *id, enum ib_event_type event)
2793{
2794 struct rdma_id_private *id_priv;
2795 int ret;
2796
2797 id_priv = container_of(id, struct rdma_id_private, id);
6c719f5c 2798 if (!cma_has_cm_dev(id_priv))
0fe313b0
SH		 2799 return -EINVAL;
2800
2801 switch (id->device->node_type) {
2802 case RDMA_NODE_IB_CA:
2803 ret = ib_cm_notify(id_priv->cm_id.ib, event);
2804 break;
2805 default:
2806 ret = 0;
2807 break;
2808 }
2809 return ret;
2810}
2811EXPORT_SYMBOL(rdma_notify);
2812
e51060f0
SH		 2813int rdma_reject(struct rdma_cm_id *id, const void *private_data,
2814 u8 private_data_len)
2815{
2816 struct rdma_id_private *id_priv;
2817 int ret;
2818
2819 id_priv = container_of(id, struct rdma_id_private, id);
6c719f5c 2820 if (!cma_has_cm_dev(id_priv))
e51060f0
SH		 2821 return -EINVAL;
2822
07ebafba
TT		 2823 switch (rdma_node_get_transport(id->device->node_type)) {
2824 case RDMA_TRANSPORT_IB:
b26f9b99 2825 if (id->qp_type == IB_QPT_UD)
628e5f6d
SH		 2826 ret = cma_send_sidr_rep(id_priv, IB_SIDR_REJECT,
2827 private_data, private_data_len);
2828 else
2829 ret = ib_send_cm_rej(id_priv->cm_id.ib,
2830 IB_CM_REJ_CONSUMER_DEFINED, NULL,
2831 0, private_data, private_data_len);
e51060f0 2832 break;
07ebafba
TT		 2833 case RDMA_TRANSPORT_IWARP:
2834 ret = iw_cm_reject(id_priv->cm_id.iw,
2835 private_data, private_data_len);
2836 break;
e51060f0
SH		 2837 default:
2838 ret = -ENOSYS;
2839 break;
2840 }
2841 return ret;
2842}
2843EXPORT_SYMBOL(rdma_reject);
2844
2845int rdma_disconnect(struct rdma_cm_id *id)
2846{
2847 struct rdma_id_private *id_priv;
2848 int ret;
2849
2850 id_priv = container_of(id, struct rdma_id_private, id);
6c719f5c 2851 if (!cma_has_cm_dev(id_priv))
e51060f0
SH		 2852 return -EINVAL;
2853
07ebafba
TT		 2854 switch (rdma_node_get_transport(id->device->node_type)) {
2855 case RDMA_TRANSPORT_IB:
c5483388 2856 ret = cma_modify_qp_err(id_priv);
07ebafba
TT		 2857 if (ret)
2858 goto out;
e51060f0
SH		 2859 /* Initiate or respond to a disconnect. */
2860 if (ib_send_cm_dreq(id_priv->cm_id.ib, NULL, 0))
2861 ib_send_cm_drep(id_priv->cm_id.ib, NULL, 0);
2862 break;
07ebafba
TT		 2863 case RDMA_TRANSPORT_IWARP:
2864 ret = iw_cm_disconnect(id_priv->cm_id.iw, 0);
2865 break;
e51060f0 2866 default:
07ebafba 2867 ret = -EINVAL;
e51060f0
SH		 2868 break;
2869 }
2870out:
2871 return ret;
2872}
2873EXPORT_SYMBOL(rdma_disconnect);
2874
c8f6a362
SH		 2875static int cma_ib_mc_handler(int status, struct ib_sa_multicast *multicast)
2876{
2877 struct rdma_id_private *id_priv;
2878 struct cma_multicast *mc = multicast->context;
2879 struct rdma_cm_event event;
2880 int ret;
2881
2882 id_priv = mc->id_priv;
550e5ca7
NM		 2883 if (cma_disable_callback(id_priv, RDMA_CM_ADDR_BOUND) &&
2884 cma_disable_callback(id_priv, RDMA_CM_ADDR_RESOLVED))
8aa08602 2885 return 0;
c8f6a362 2886
c5483388 2887 mutex_lock(&id_priv->qp_mutex);
c8f6a362
SH		 2888 if (!status && id_priv->id.qp)
2889 status = ib_attach_mcast(id_priv->id.qp, &multicast->rec.mgid,
2890 multicast->rec.mlid);
c5483388 2891 mutex_unlock(&id_priv->qp_mutex);
c8f6a362
SH		 2892
2893 memset(&event, 0, sizeof event);
2894 event.status = status;
2895 event.param.ud.private_data = mc->context;
2896 if (!status) {
2897 event.event = RDMA_CM_EVENT_MULTICAST_JOIN;
2898 ib_init_ah_from_mcmember(id_priv->id.device,
2899 id_priv->id.port_num, &multicast->rec,
2900 &event.param.ud.ah_attr);
2901 event.param.ud.qp_num = 0xFFFFFF;
2902 event.param.ud.qkey = be32_to_cpu(multicast->rec.qkey);
2903 } else
2904 event.event = RDMA_CM_EVENT_MULTICAST_ERROR;
2905
2906 ret = id_priv->id.event_handler(&id_priv->id, &event);
2907 if (ret) {
550e5ca7 2908 cma_exch(id_priv, RDMA_CM_DESTROYING);
de910bd9 2909 mutex_unlock(&id_priv->handler_mutex);
c8f6a362
SH		 2910 rdma_destroy_id(&id_priv->id);
2911 return 0;
2912 }
8aa08602 2913
de910bd9 2914 mutex_unlock(&id_priv->handler_mutex);
c8f6a362
SH		 2915 return 0;
2916}
2917
2918static void cma_set_mgid(struct rdma_id_private *id_priv,
2919 struct sockaddr *addr, union ib_gid *mgid)
2920{
2921 unsigned char mc_map[MAX_ADDR_LEN];
2922 struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr;
2923 struct sockaddr_in *sin = (struct sockaddr_in *) addr;
2924 struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *) addr;
2925
2926 if (cma_any_addr(addr)) {
2927 memset(mgid, 0, sizeof *mgid);
2928 } else if ((addr->sa_family == AF_INET6) &&
1c9b2819 2929 ((be32_to_cpu(sin6->sin6_addr.s6_addr32[0]) & 0xFFF0FFFF) ==
c8f6a362
SH		 2930 0xFF10A01B)) {
2931 /* IPv6 address is an SA assigned MGID. */
2932 memcpy(mgid, &sin6->sin6_addr, sizeof *mgid);
e2e62697
JG		 2933 } else if ((addr->sa_family == AF_INET6)) {
2934 ipv6_ib_mc_map(&sin6->sin6_addr, dev_addr->broadcast, mc_map);
2935 if (id_priv->id.ps == RDMA_PS_UDP)
2936 mc_map[7] = 0x01; /* Use RDMA CM signature */
2937 *mgid = *(union ib_gid *) (mc_map + 4);
c8f6a362 2938 } else {
a9e527e3 2939 ip_ib_mc_map(sin->sin_addr.s_addr, dev_addr->broadcast, mc_map);
c8f6a362
SH		 2940 if (id_priv->id.ps == RDMA_PS_UDP)
2941 mc_map[7] = 0x01; /* Use RDMA CM signature */
c8f6a362
SH		 2942 *mgid = *(union ib_gid *) (mc_map + 4);
2943 }
2944}
2945
2946static int cma_join_ib_multicast(struct rdma_id_private *id_priv,
2947 struct cma_multicast *mc)
2948{
2949 struct ib_sa_mcmember_rec rec;
2950 struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr;
2951 ib_sa_comp_mask comp_mask;
2952 int ret;
2953
2954 ib_addr_get_mgid(dev_addr, &rec.mgid);
2955 ret = ib_sa_get_mcmember_rec(id_priv->id.device, id_priv->id.port_num,
2956 &rec.mgid, &rec);
2957 if (ret)
2958 return ret;
2959
3f446754 2960 cma_set_mgid(id_priv, (struct sockaddr *) &mc->addr, &rec.mgid);
c8f6a362
SH		 2961 if (id_priv->id.ps == RDMA_PS_UDP)
2962 rec.qkey = cpu_to_be32(RDMA_UDP_QKEY);
6f8372b6 2963 rdma_addr_get_sgid(dev_addr, &rec.port_gid);
c8f6a362
SH		 2964 rec.pkey = cpu_to_be16(ib_addr_get_pkey(dev_addr));
2965 rec.join_state = 1;
2966
2967 comp_mask = IB_SA_MCMEMBER_REC_MGID | IB_SA_MCMEMBER_REC_PORT_GID |
2968 IB_SA_MCMEMBER_REC_PKEY | IB_SA_MCMEMBER_REC_JOIN_STATE |
2969 IB_SA_MCMEMBER_REC_QKEY | IB_SA_MCMEMBER_REC_SL |
2970 IB_SA_MCMEMBER_REC_FLOW_LABEL |
2971 IB_SA_MCMEMBER_REC_TRAFFIC_CLASS;
2972
84adeee9
YE		 2973 if (id_priv->id.ps == RDMA_PS_IPOIB)
2974 comp_mask |= IB_SA_MCMEMBER_REC_RATE |
2975 IB_SA_MCMEMBER_REC_RATE_SELECTOR;
2976
c8f6a362
SH		 2977 mc->multicast.ib = ib_sa_join_multicast(&sa_client, id_priv->id.device,
2978 id_priv->id.port_num, &rec,
2979 comp_mask, GFP_KERNEL,
2980 cma_ib_mc_handler, mc);
2981 if (IS_ERR(mc->multicast.ib))
2982 return PTR_ERR(mc->multicast.ib);
2983
2984 return 0;
2985}
2986
3c86aa70
EC		 2987static void iboe_mcast_work_handler(struct work_struct *work)
2988{
2989 struct iboe_mcast_work *mw = container_of(work, struct iboe_mcast_work, work);
2990 struct cma_multicast *mc = mw->mc;
2991 struct ib_sa_multicast *m = mc->multicast.ib;
2992
2993 mc->multicast.ib->context = mc;
2994 cma_ib_mc_handler(0, m);
2995 kref_put(&mc->mcref, release_mc);
2996 kfree(mw);
2997}
2998
2999static void cma_iboe_set_mgid(struct sockaddr *addr, union ib_gid *mgid)
3000{
3001 struct sockaddr_in *sin = (struct sockaddr_in *)addr;
3002 struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)addr;
3003
3004 if (cma_any_addr(addr)) {
3005 memset(mgid, 0, sizeof *mgid);
3006 } else if (addr->sa_family == AF_INET6) {
3007 memcpy(mgid, &sin6->sin6_addr, sizeof *mgid);
3008 } else {
3009 mgid->raw[0] = 0xff;
3010 mgid->raw[1] = 0x0e;
3011 mgid->raw[2] = 0;
3012 mgid->raw[3] = 0;
3013 mgid->raw[4] = 0;
3014 mgid->raw[5] = 0;
3015 mgid->raw[6] = 0;
3016 mgid->raw[7] = 0;
3017 mgid->raw[8] = 0;
3018 mgid->raw[9] = 0;
3019 mgid->raw[10] = 0xff;
3020 mgid->raw[11] = 0xff;
3021 *(__be32 *)(&mgid->raw[12]) = sin->sin_addr.s_addr;
3022 }
3023}
3024
3025static int cma_iboe_join_multicast(struct rdma_id_private *id_priv,
3026 struct cma_multicast *mc)
3027{
3028 struct iboe_mcast_work *work;
3029 struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr;
3030 int err;
3031 struct sockaddr *addr = (struct sockaddr *)&mc->addr;
3032 struct net_device *ndev = NULL;
3033
3034 if (cma_zero_addr((struct sockaddr *)&mc->addr))
3035 return -EINVAL;
3036
3037 work = kzalloc(sizeof *work, GFP_KERNEL);
3038 if (!work)
3039 return -ENOMEM;
3040
3041 mc->multicast.ib = kzalloc(sizeof(struct ib_sa_multicast), GFP_KERNEL);
3042 if (!mc->multicast.ib) {
3043 err = -ENOMEM;
3044 goto out1;
3045 }
3046
3047 cma_iboe_set_mgid(addr, &mc->multicast.ib->rec.mgid);
3048
3049 mc->multicast.ib->rec.pkey = cpu_to_be16(0xffff);
3050 if (id_priv->id.ps == RDMA_PS_UDP)
3051 mc->multicast.ib->rec.qkey = cpu_to_be32(RDMA_UDP_QKEY);
3052
3053 if (dev_addr->bound_dev_if)
3054 ndev = dev_get_by_index(&init_net, dev_addr->bound_dev_if);
3055 if (!ndev) {
3056 err = -ENODEV;
3057 goto out2;
3058 }
3059 mc->multicast.ib->rec.rate = iboe_get_rate(ndev);
3060 mc->multicast.ib->rec.hop_limit = 1;
3061 mc->multicast.ib->rec.mtu = iboe_get_mtu(ndev->mtu);
3062 dev_put(ndev);
3063 if (!mc->multicast.ib->rec.mtu) {
3064 err = -EINVAL;
3065 goto out2;
3066 }
3067 iboe_addr_get_sgid(dev_addr, &mc->multicast.ib->rec.port_gid);
3068 work->id = id_priv;
3069 work->mc = mc;
3070 INIT_WORK(&work->work, iboe_mcast_work_handler);
3071 kref_get(&mc->mcref);
3072 queue_work(cma_wq, &work->work);
3073
3074 return 0;
3075
3076out2:
3077 kfree(mc->multicast.ib);
3078out1:
3079 kfree(work);
3080 return err;
3081}
3082
c8f6a362
SH		 3083int rdma_join_multicast(struct rdma_cm_id *id, struct sockaddr *addr,
3084 void *context)
3085{
3086 struct rdma_id_private *id_priv;
3087 struct cma_multicast *mc;
3088 int ret;
3089
3090 id_priv = container_of(id, struct rdma_id_private, id);
550e5ca7
NM		 3091 if (!cma_comp(id_priv, RDMA_CM_ADDR_BOUND) &&
3092 !cma_comp(id_priv, RDMA_CM_ADDR_RESOLVED))
c8f6a362
SH		 3093 return -EINVAL;
3094
3095 mc = kmalloc(sizeof *mc, GFP_KERNEL);
3096 if (!mc)
3097 return -ENOMEM;
3098
3099 memcpy(&mc->addr, addr, ip_addr_size(addr));
3100 mc->context = context;
3101 mc->id_priv = id_priv;
3102
3103 spin_lock(&id_priv->lock);
3104 list_add(&mc->list, &id_priv->mc_list);
3105 spin_unlock(&id_priv->lock);
3106
3107 switch (rdma_node_get_transport(id->device->node_type)) {
3108 case RDMA_TRANSPORT_IB:
3c86aa70
EC		 3109 switch (rdma_port_get_link_layer(id->device, id->port_num)) {
3110 case IB_LINK_LAYER_INFINIBAND:
3111 ret = cma_join_ib_multicast(id_priv, mc);
3112 break;
3113 case IB_LINK_LAYER_ETHERNET:
3114 kref_init(&mc->mcref);
3115 ret = cma_iboe_join_multicast(id_priv, mc);
3116 break;
3117 default:
3118 ret = -EINVAL;
3119 }
c8f6a362
SH		 3120 break;
3121 default:
3122 ret = -ENOSYS;
3123 break;
3124 }
3125
3126 if (ret) {
3127 spin_lock_irq(&id_priv->lock);
3128 list_del(&mc->list);
3129 spin_unlock_irq(&id_priv->lock);
3130 kfree(mc);
3131 }
3132 return ret;
3133}
3134EXPORT_SYMBOL(rdma_join_multicast);
3135
3136void rdma_leave_multicast(struct rdma_cm_id *id, struct sockaddr *addr)
3137{
3138 struct rdma_id_private *id_priv;
3139 struct cma_multicast *mc;
3140
3141 id_priv = container_of(id, struct rdma_id_private, id);
3142 spin_lock_irq(&id_priv->lock);
3143 list_for_each_entry(mc, &id_priv->mc_list, list) {
3144 if (!memcmp(&mc->addr, addr, ip_addr_size(addr))) {
3145 list_del(&mc->list);
3146 spin_unlock_irq(&id_priv->lock);
3147
3148 if (id->qp)
3149 ib_detach_mcast(id->qp,
3150 &mc->multicast.ib->rec.mgid,
3151 mc->multicast.ib->rec.mlid);
3c86aa70
EC		 3152 if (rdma_node_get_transport(id_priv->cma_dev->device->node_type) == RDMA_TRANSPORT_IB) {
3153 switch (rdma_port_get_link_layer(id->device, id->port_num)) {
3154 case IB_LINK_LAYER_INFINIBAND:
3155 ib_sa_free_multicast(mc->multicast.ib);
3156 kfree(mc);
3157 break;
3158 case IB_LINK_LAYER_ETHERNET:
3159 kref_put(&mc->mcref, release_mc);
3160 break;
3161 default:
3162 break;
3163 }
3164 }
c8f6a362
SH		 3165 return;
3166 }
3167 }
3168 spin_unlock_irq(&id_priv->lock);
3169}
3170EXPORT_SYMBOL(rdma_leave_multicast);
3171
dd5bdff8
OG		 3172static int cma_netdev_change(struct net_device *ndev, struct rdma_id_private *id_priv)
3173{
3174 struct rdma_dev_addr *dev_addr;
3175 struct cma_ndev_work *work;
3176
3177 dev_addr = &id_priv->id.route.addr.dev_addr;
3178
6266ed6e 3179 if ((dev_addr->bound_dev_if == ndev->ifindex) &&
dd5bdff8
OG		 3180 memcmp(dev_addr->src_dev_addr, ndev->dev_addr, ndev->addr_len)) {
3181 printk(KERN_INFO "RDMA CM addr change for ndev %s used by id %p\n",
3182 ndev->name, &id_priv->id);
3183 work = kzalloc(sizeof *work, GFP_KERNEL);
3184 if (!work)
3185 return -ENOMEM;
3186
3187 INIT_WORK(&work->work, cma_ndev_work_handler);
3188 work->id = id_priv;
3189 work->event.event = RDMA_CM_EVENT_ADDR_CHANGE;
3190 atomic_inc(&id_priv->refcount);
3191 queue_work(cma_wq, &work->work);
3192 }
3193
3194 return 0;
3195}
3196
3197static int cma_netdev_callback(struct notifier_block *self, unsigned long event,
3198 void *ctx)
3199{
3200 struct net_device *ndev = (struct net_device *)ctx;
3201 struct cma_device *cma_dev;
3202 struct rdma_id_private *id_priv;
3203 int ret = NOTIFY_DONE;
3204
3205 if (dev_net(ndev) != &init_net)
3206 return NOTIFY_DONE;
3207
3208 if (event != NETDEV_BONDING_FAILOVER)
3209 return NOTIFY_DONE;
3210
3211 if (!(ndev->flags & IFF_MASTER) || !(ndev->priv_flags & IFF_BONDING))
3212 return NOTIFY_DONE;
3213
3214 mutex_lock(&lock);
3215 list_for_each_entry(cma_dev, &dev_list, list)
3216 list_for_each_entry(id_priv, &cma_dev->id_list, list) {
3217 ret = cma_netdev_change(ndev, id_priv);
3218 if (ret)
3219 goto out;
3220 }
3221
3222out:
3223 mutex_unlock(&lock);
3224 return ret;
3225}
3226
3227static struct notifier_block cma_nb = {
3228 .notifier_call = cma_netdev_callback
3229};
3230
e51060f0
SH		 3231static void cma_add_one(struct ib_device *device)
3232{
3233 struct cma_device *cma_dev;
3234 struct rdma_id_private *id_priv;
3235
3236 cma_dev = kmalloc(sizeof *cma_dev, GFP_KERNEL);
3237 if (!cma_dev)
3238 return;
3239
3240 cma_dev->device = device;
e51060f0
SH		 3241
3242 init_completion(&cma_dev->comp);
3243 atomic_set(&cma_dev->refcount, 1);
3244 INIT_LIST_HEAD(&cma_dev->id_list);
3245 ib_set_client_data(device, &cma_client, cma_dev);
3246
3247 mutex_lock(&lock);
3248 list_add_tail(&cma_dev->list, &dev_list);
3249 list_for_each_entry(id_priv, &listen_any_list, list)
3250 cma_listen_on_dev(id_priv, cma_dev);
3251 mutex_unlock(&lock);
e51060f0
SH		 3252}
3253
3254static int cma_remove_id_dev(struct rdma_id_private *id_priv)
3255{
a1b1b61f 3256 struct rdma_cm_event event;
550e5ca7 3257 enum rdma_cm_state state;
de910bd9 3258 int ret = 0;
e51060f0
SH		 3259
3260 /* Record that we want to remove the device */
550e5ca7
NM		 3261 state = cma_exch(id_priv, RDMA_CM_DEVICE_REMOVAL);
3262 if (state == RDMA_CM_DESTROYING)
e51060f0
SH		 3263 return 0;
3264
3265 cma_cancel_operation(id_priv, state);
de910bd9 3266 mutex_lock(&id_priv->handler_mutex);
e51060f0
SH		 3267
3268 /* Check for destruction from another callback. */
550e5ca7 3269 if (!cma_comp(id_priv, RDMA_CM_DEVICE_REMOVAL))
de910bd9 3270 goto out;
e51060f0 3271
a1b1b61f
SH		 3272 memset(&event, 0, sizeof event);
3273 event.event = RDMA_CM_EVENT_DEVICE_REMOVAL;
de910bd9
OG		 3274 ret = id_priv->id.event_handler(&id_priv->id, &event);
3275out:
3276 mutex_unlock(&id_priv->handler_mutex);
3277 return ret;
e51060f0
SH		 3278}
3279
3280static void cma_process_remove(struct cma_device *cma_dev)
3281{
e51060f0
SH		 3282 struct rdma_id_private *id_priv;
3283 int ret;
3284
e51060f0
SH		 3285 mutex_lock(&lock);
3286 while (!list_empty(&cma_dev->id_list)) {
3287 id_priv = list_entry(cma_dev->id_list.next,
3288 struct rdma_id_private, list);
3289
d02d1f53 3290 list_del(&id_priv->listen_list);
94de178a 3291 list_del_init(&id_priv->list);
e51060f0
SH		 3292 atomic_inc(&id_priv->refcount);
3293 mutex_unlock(&lock);
3294
d02d1f53 3295 ret = id_priv->internal_id ? 1 : cma_remove_id_dev(id_priv);
e51060f0
SH		 3296 cma_deref_id(id_priv);
3297 if (ret)
3298 rdma_destroy_id(&id_priv->id);
3299
3300 mutex_lock(&lock);
3301 }
3302 mutex_unlock(&lock);
3303
3304 cma_deref_dev(cma_dev);
3305 wait_for_completion(&cma_dev->comp);
3306}
3307
3308static void cma_remove_one(struct ib_device *device)
3309{
3310 struct cma_device *cma_dev;
3311
3312 cma_dev = ib_get_client_data(device, &cma_client);
3313 if (!cma_dev)
3314 return;
3315
3316 mutex_lock(&lock);
3317 list_del(&cma_dev->list);
3318 mutex_unlock(&lock);
3319
3320 cma_process_remove(cma_dev);
3321 kfree(cma_dev);
3322}
3323
753f618a
NM		 3324static int cma_get_id_stats(struct sk_buff *skb, struct netlink_callback *cb)
3325{
3326 struct nlmsghdr *nlh;
3327 struct rdma_cm_id_stats *id_stats;
3328 struct rdma_id_private *id_priv;
3329 struct rdma_cm_id *id = NULL;
3330 struct cma_device *cma_dev;
3331 int i_dev = 0, i_id = 0;
3332
3333 /*
3334 * We export all of the IDs as a sequence of messages. Each
3335 * ID gets its own netlink message.
3336 */
3337 mutex_lock(&lock);
3338
3339 list_for_each_entry(cma_dev, &dev_list, list) {
3340 if (i_dev < cb->args[0]) {
3341 i_dev++;
3342 continue;
3343 }
3344
3345 i_id = 0;
3346 list_for_each_entry(id_priv, &cma_dev->id_list, list) {
3347 if (i_id < cb->args[1]) {
3348 i_id++;
3349 continue;
3350 }
3351
3352 id_stats = ibnl_put_msg(skb, &nlh, cb->nlh->nlmsg_seq,
3353 sizeof *id_stats, RDMA_NL_RDMA_CM,
3354 RDMA_NL_RDMA_CM_ID_STATS);
3355 if (!id_stats)
3356 goto out;
3357
3358 memset(id_stats, 0, sizeof *id_stats);
3359 id = &id_priv->id;
3360 id_stats->node_type = id->route.addr.dev_addr.dev_type;
3361 id_stats->port_num = id->port_num;
3362 id_stats->bound_dev_if =
3363 id->route.addr.dev_addr.bound_dev_if;
3364
3365 if (id->route.addr.src_addr.ss_family == AF_INET) {
3366 if (ibnl_put_attr(skb, nlh,
3367 sizeof(struct sockaddr_in),
3368 &id->route.addr.src_addr,
3369 RDMA_NL_RDMA_CM_ATTR_SRC_ADDR)) {
3370 goto out;
3371 }
3372 if (ibnl_put_attr(skb, nlh,
3373 sizeof(struct sockaddr_in),
3374 &id->route.addr.dst_addr,
3375 RDMA_NL_RDMA_CM_ATTR_DST_ADDR)) {
3376 goto out;
3377 }
3378 } else if (id->route.addr.src_addr.ss_family == AF_INET6) {
3379 if (ibnl_put_attr(skb, nlh,
3380 sizeof(struct sockaddr_in6),
3381 &id->route.addr.src_addr,
3382 RDMA_NL_RDMA_CM_ATTR_SRC_ADDR)) {
3383 goto out;
3384 }
3385 if (ibnl_put_attr(skb, nlh,
3386 sizeof(struct sockaddr_in6),
3387 &id->route.addr.dst_addr,
3388 RDMA_NL_RDMA_CM_ATTR_DST_ADDR)) {
3389 goto out;
3390 }
3391 }
3392
83e9502d 3393 id_stats->pid = id_priv->owner;
753f618a
NM		 3394 id_stats->port_space = id->ps;
3395 id_stats->cm_state = id_priv->state;
3396 id_stats->qp_num = id_priv->qp_num;
3397 id_stats->qp_type = id->qp_type;
3398
3399 i_id++;
3400 }
3401
3402 cb->args[1] = 0;
3403 i_dev++;
3404 }
3405
3406out:
3407 mutex_unlock(&lock);
3408 cb->args[0] = i_dev;
3409 cb->args[1] = i_id;
3410
3411 return skb->len;
3412}
3413
3414static const struct ibnl_client_cbs cma_cb_table[] = {
3415 [RDMA_NL_RDMA_CM_ID_STATS] = { .dump = cma_get_id_stats },
3416};
3417
716abb1f 3418static int __init cma_init(void)
e51060f0 3419{
5d7220e8 3420 int ret;
227b60f5 3421
c7f743a6 3422 cma_wq = create_singlethread_workqueue("rdma_cm");
e51060f0
SH		 3423 if (!cma_wq)
3424 return -ENOMEM;
3425
c1a0b23b 3426 ib_sa_register_client(&sa_client);
7a118df3 3427 rdma_addr_register_client(&addr_client);
dd5bdff8 3428 register_netdevice_notifier(&cma_nb);
c1a0b23b 3429
e51060f0
SH		 3430 ret = ib_register_client(&cma_client);
3431 if (ret)
3432 goto err;
753f618a
NM		 3433
3434 if (ibnl_add_client(RDMA_NL_RDMA_CM, RDMA_NL_RDMA_CM_NUM_OPS, cma_cb_table))
3435 printk(KERN_WARNING "RDMA CMA: failed to add netlink callback\n");
3436
e51060f0
SH		 3437 return 0;
3438
3439err:
dd5bdff8 3440 unregister_netdevice_notifier(&cma_nb);
7a118df3 3441 rdma_addr_unregister_client(&addr_client);
c1a0b23b 3442 ib_sa_unregister_client(&sa_client);
e51060f0
SH		 3443 destroy_workqueue(cma_wq);
3444 return ret;
3445}
3446
716abb1f 3447static void __exit cma_cleanup(void)
e51060f0 3448{
753f618a 3449 ibnl_remove_client(RDMA_NL_RDMA_CM);
e51060f0 3450 ib_unregister_client(&cma_client);
dd5bdff8 3451 unregister_netdevice_notifier(&cma_nb);
7a118df3 3452 rdma_addr_unregister_client(&addr_client);
c1a0b23b 3453 ib_sa_unregister_client(&sa_client);
e51060f0
SH		 3454 destroy_workqueue(cma_wq);
3455 idr_destroy(&sdp_ps);
3456 idr_destroy(&tcp_ps);
628e5f6d 3457 idr_destroy(&udp_ps);
c8f6a362 3458 idr_destroy(&ipoib_ps);
e51060f0
SH		 3459}
3460
3461module_init(cma_init);
3462module_exit(cma_cleanup);
kernel source for telekom puls (alcatel/mediatek)