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.
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:
13 * Redistribution and use in source and binary forms, with or
14 * without modification, are permitted provided that the following
17 * - Redistributions of source code must retain the above
18 * copyright notice, this list of conditions and the following
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.
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
36 #include <linux/completion.h>
38 #include <linux/in6.h>
39 #include <linux/mutex.h>
40 #include <linux/random.h>
41 #include <linux/igmp.h>
42 #include <linux/idr.h>
43 #include <linux/inetdevice.h>
44 #include <linux/slab.h>
45 #include <linux/module.h>
46 #include <net/route.h>
48 #include <net/net_namespace.h>
49 #include <net/netns/generic.h>
52 #include <net/ip_fib.h>
53 #include <net/ip6_route.h>
55 #include <rdma/rdma_cm.h>
56 #include <rdma/rdma_cm_ib.h>
57 #include <rdma/rdma_netlink.h>
59 #include <rdma/ib_cache.h>
60 #include <rdma/ib_cm.h>
61 #include <rdma/ib_sa.h>
62 #include <rdma/iw_cm.h>
64 #include "core_priv.h"
66 MODULE_AUTHOR("Sean Hefty");
67 MODULE_DESCRIPTION("Generic RDMA CM Agent");
68 MODULE_LICENSE("Dual BSD/GPL");
70 #define CMA_CM_RESPONSE_TIMEOUT 20
71 #define CMA_QUERY_CLASSPORT_INFO_TIMEOUT 3000
72 #define CMA_MAX_CM_RETRIES 15
73 #define CMA_CM_MRA_SETTING (IB_CM_MRA_FLAG_DELAY | 24)
74 #define CMA_IBOE_PACKET_LIFETIME 18
75 #define CMA_PREFERRED_ROCE_GID_TYPE (1 << IB_GID_TYPE_ROCE_UDP_ENCAP)
77 static const char * const cma_events
[] = {
78 [RDMA_CM_EVENT_ADDR_RESOLVED
] = "address resolved",
79 [RDMA_CM_EVENT_ADDR_ERROR
] = "address error",
80 [RDMA_CM_EVENT_ROUTE_RESOLVED
] = "route resolved ",
81 [RDMA_CM_EVENT_ROUTE_ERROR
] = "route error",
82 [RDMA_CM_EVENT_CONNECT_REQUEST
] = "connect request",
83 [RDMA_CM_EVENT_CONNECT_RESPONSE
] = "connect response",
84 [RDMA_CM_EVENT_CONNECT_ERROR
] = "connect error",
85 [RDMA_CM_EVENT_UNREACHABLE
] = "unreachable",
86 [RDMA_CM_EVENT_REJECTED
] = "rejected",
87 [RDMA_CM_EVENT_ESTABLISHED
] = "established",
88 [RDMA_CM_EVENT_DISCONNECTED
] = "disconnected",
89 [RDMA_CM_EVENT_DEVICE_REMOVAL
] = "device removal",
90 [RDMA_CM_EVENT_MULTICAST_JOIN
] = "multicast join",
91 [RDMA_CM_EVENT_MULTICAST_ERROR
] = "multicast error",
92 [RDMA_CM_EVENT_ADDR_CHANGE
] = "address change",
93 [RDMA_CM_EVENT_TIMEWAIT_EXIT
] = "timewait exit",
96 const char *__attribute_const__
rdma_event_msg(enum rdma_cm_event_type event
)
100 return (index
< ARRAY_SIZE(cma_events
) && cma_events
[index
]) ?
101 cma_events
[index
] : "unrecognized event";
103 EXPORT_SYMBOL(rdma_event_msg
);
105 const char *__attribute_const__
rdma_reject_msg(struct rdma_cm_id
*id
,
108 if (rdma_ib_or_roce(id
->device
, id
->port_num
))
109 return ibcm_reject_msg(reason
);
111 if (rdma_protocol_iwarp(id
->device
, id
->port_num
))
112 return iwcm_reject_msg(reason
);
115 return "unrecognized transport";
117 EXPORT_SYMBOL(rdma_reject_msg
);
119 bool rdma_is_consumer_reject(struct rdma_cm_id
*id
, int reason
)
121 if (rdma_ib_or_roce(id
->device
, id
->port_num
))
122 return reason
== IB_CM_REJ_CONSUMER_DEFINED
;
124 if (rdma_protocol_iwarp(id
->device
, id
->port_num
))
125 return reason
== -ECONNREFUSED
;
130 EXPORT_SYMBOL(rdma_is_consumer_reject
);
132 const void *rdma_consumer_reject_data(struct rdma_cm_id
*id
,
133 struct rdma_cm_event
*ev
, u8
*data_len
)
137 if (rdma_is_consumer_reject(id
, ev
->status
)) {
138 *data_len
= ev
->param
.conn
.private_data_len
;
139 p
= ev
->param
.conn
.private_data
;
146 EXPORT_SYMBOL(rdma_consumer_reject_data
);
148 static void cma_add_one(struct ib_device
*device
);
149 static void cma_remove_one(struct ib_device
*device
, void *client_data
);
151 static struct ib_client cma_client
= {
154 .remove
= cma_remove_one
157 static struct ib_sa_client sa_client
;
158 static struct rdma_addr_client addr_client
;
159 static LIST_HEAD(dev_list
);
160 static LIST_HEAD(listen_any_list
);
161 static DEFINE_MUTEX(lock
);
162 static struct workqueue_struct
*cma_wq
;
163 static unsigned int cma_pernet_id
;
172 static struct cma_pernet
*cma_pernet(struct net
*net
)
174 return net_generic(net
, cma_pernet_id
);
177 static struct idr
*cma_pernet_idr(struct net
*net
, enum rdma_port_space ps
)
179 struct cma_pernet
*pernet
= cma_pernet(net
);
183 return &pernet
->tcp_ps
;
185 return &pernet
->udp_ps
;
187 return &pernet
->ipoib_ps
;
189 return &pernet
->ib_ps
;
196 struct list_head list
;
197 struct ib_device
*device
;
198 struct completion comp
;
200 struct list_head id_list
;
201 enum ib_gid_type
*default_gid_type
;
202 u8
*default_roce_tos
;
205 struct rdma_bind_list
{
206 enum rdma_port_space ps
;
207 struct hlist_head owners
;
211 struct class_port_info_context
{
212 struct ib_class_port_info
*class_port_info
;
213 struct ib_device
*device
;
214 struct completion done
;
215 struct ib_sa_query
*sa_query
;
219 static int cma_ps_alloc(struct net
*net
, enum rdma_port_space ps
,
220 struct rdma_bind_list
*bind_list
, int snum
)
222 struct idr
*idr
= cma_pernet_idr(net
, ps
);
224 return idr_alloc(idr
, bind_list
, snum
, snum
+ 1, GFP_KERNEL
);
227 static struct rdma_bind_list
*cma_ps_find(struct net
*net
,
228 enum rdma_port_space ps
, int snum
)
230 struct idr
*idr
= cma_pernet_idr(net
, ps
);
232 return idr_find(idr
, snum
);
235 static void cma_ps_remove(struct net
*net
, enum rdma_port_space ps
, int snum
)
237 struct idr
*idr
= cma_pernet_idr(net
, ps
);
239 idr_remove(idr
, snum
);
246 void cma_ref_dev(struct cma_device
*cma_dev
)
248 atomic_inc(&cma_dev
->refcount
);
251 struct cma_device
*cma_enum_devices_by_ibdev(cma_device_filter filter
,
254 struct cma_device
*cma_dev
;
255 struct cma_device
*found_cma_dev
= NULL
;
259 list_for_each_entry(cma_dev
, &dev_list
, list
)
260 if (filter(cma_dev
->device
, cookie
)) {
261 found_cma_dev
= cma_dev
;
266 cma_ref_dev(found_cma_dev
);
268 return found_cma_dev
;
271 int cma_get_default_gid_type(struct cma_device
*cma_dev
,
274 if (!rdma_is_port_valid(cma_dev
->device
, port
))
277 return cma_dev
->default_gid_type
[port
- rdma_start_port(cma_dev
->device
)];
280 int cma_set_default_gid_type(struct cma_device
*cma_dev
,
282 enum ib_gid_type default_gid_type
)
284 unsigned long supported_gids
;
286 if (!rdma_is_port_valid(cma_dev
->device
, port
))
289 supported_gids
= roce_gid_type_mask_support(cma_dev
->device
, port
);
291 if (!(supported_gids
& 1 << default_gid_type
))
294 cma_dev
->default_gid_type
[port
- rdma_start_port(cma_dev
->device
)] =
300 int cma_get_default_roce_tos(struct cma_device
*cma_dev
, unsigned int port
)
302 if (!rdma_is_port_valid(cma_dev
->device
, port
))
305 return cma_dev
->default_roce_tos
[port
- rdma_start_port(cma_dev
->device
)];
308 int cma_set_default_roce_tos(struct cma_device
*cma_dev
, unsigned int port
,
311 if (!rdma_is_port_valid(cma_dev
->device
, port
))
314 cma_dev
->default_roce_tos
[port
- rdma_start_port(cma_dev
->device
)] =
319 struct ib_device
*cma_get_ib_dev(struct cma_device
*cma_dev
)
321 return cma_dev
->device
;
325 * Device removal can occur at anytime, so we need extra handling to
326 * serialize notifying the user of device removal with other callbacks.
327 * We do this by disabling removal notification while a callback is in process,
328 * and reporting it after the callback completes.
330 struct rdma_id_private
{
331 struct rdma_cm_id id
;
333 struct rdma_bind_list
*bind_list
;
334 struct hlist_node node
;
335 struct list_head list
; /* listen_any_list or cma_device.list */
336 struct list_head listen_list
; /* per device listens */
337 struct cma_device
*cma_dev
;
338 struct list_head mc_list
;
341 enum rdma_cm_state state
;
343 struct mutex qp_mutex
;
345 struct completion comp
;
347 struct mutex handler_mutex
;
351 struct ib_sa_query
*query
;
368 enum ib_gid_type gid_type
;
371 struct cma_multicast
{
372 struct rdma_id_private
*id_priv
;
374 struct ib_sa_multicast
*ib
;
376 struct list_head list
;
378 struct sockaddr_storage addr
;
385 struct work_struct work
;
386 struct rdma_id_private
*id
;
387 enum rdma_cm_state old_state
;
388 enum rdma_cm_state new_state
;
389 struct rdma_cm_event event
;
392 struct cma_ndev_work
{
393 struct work_struct work
;
394 struct rdma_id_private
*id
;
395 struct rdma_cm_event event
;
398 struct iboe_mcast_work
{
399 struct work_struct work
;
400 struct rdma_id_private
*id
;
401 struct cma_multicast
*mc
;
414 u8 ip_version
; /* IP version: 7:4 */
416 union cma_ip_addr src_addr
;
417 union cma_ip_addr dst_addr
;
420 #define CMA_VERSION 0x00
422 struct cma_req_info
{
423 struct ib_device
*device
;
425 union ib_gid local_gid
;
431 static int cma_comp(struct rdma_id_private
*id_priv
, enum rdma_cm_state comp
)
436 spin_lock_irqsave(&id_priv
->lock
, flags
);
437 ret
= (id_priv
->state
== comp
);
438 spin_unlock_irqrestore(&id_priv
->lock
, flags
);
442 static int cma_comp_exch(struct rdma_id_private
*id_priv
,
443 enum rdma_cm_state comp
, enum rdma_cm_state exch
)
448 spin_lock_irqsave(&id_priv
->lock
, flags
);
449 if ((ret
= (id_priv
->state
== comp
)))
450 id_priv
->state
= exch
;
451 spin_unlock_irqrestore(&id_priv
->lock
, flags
);
455 static enum rdma_cm_state
cma_exch(struct rdma_id_private
*id_priv
,
456 enum rdma_cm_state exch
)
459 enum rdma_cm_state old
;
461 spin_lock_irqsave(&id_priv
->lock
, flags
);
462 old
= id_priv
->state
;
463 id_priv
->state
= exch
;
464 spin_unlock_irqrestore(&id_priv
->lock
, flags
);
468 static inline u8
cma_get_ip_ver(const struct cma_hdr
*hdr
)
470 return hdr
->ip_version
>> 4;
473 static inline void cma_set_ip_ver(struct cma_hdr
*hdr
, u8 ip_ver
)
475 hdr
->ip_version
= (ip_ver
<< 4) | (hdr
->ip_version
& 0xF);
478 static int cma_igmp_send(struct net_device
*ndev
, union ib_gid
*mgid
, bool join
)
480 struct in_device
*in_dev
= NULL
;
484 in_dev
= __in_dev_get_rtnl(ndev
);
487 ip_mc_inc_group(in_dev
,
488 *(__be32
*)(mgid
->raw
+ 12));
490 ip_mc_dec_group(in_dev
,
491 *(__be32
*)(mgid
->raw
+ 12));
495 return (in_dev
) ? 0 : -ENODEV
;
498 static void _cma_attach_to_dev(struct rdma_id_private
*id_priv
,
499 struct cma_device
*cma_dev
)
501 cma_ref_dev(cma_dev
);
502 id_priv
->cma_dev
= cma_dev
;
503 id_priv
->gid_type
= 0;
504 id_priv
->id
.device
= cma_dev
->device
;
505 id_priv
->id
.route
.addr
.dev_addr
.transport
=
506 rdma_node_get_transport(cma_dev
->device
->node_type
);
507 list_add_tail(&id_priv
->list
, &cma_dev
->id_list
);
510 static void cma_attach_to_dev(struct rdma_id_private
*id_priv
,
511 struct cma_device
*cma_dev
)
513 _cma_attach_to_dev(id_priv
, cma_dev
);
515 cma_dev
->default_gid_type
[id_priv
->id
.port_num
-
516 rdma_start_port(cma_dev
->device
)];
519 void cma_deref_dev(struct cma_device
*cma_dev
)
521 if (atomic_dec_and_test(&cma_dev
->refcount
))
522 complete(&cma_dev
->comp
);
525 static inline void release_mc(struct kref
*kref
)
527 struct cma_multicast
*mc
= container_of(kref
, struct cma_multicast
, mcref
);
529 kfree(mc
->multicast
.ib
);
533 static void cma_release_dev(struct rdma_id_private
*id_priv
)
536 list_del(&id_priv
->list
);
537 cma_deref_dev(id_priv
->cma_dev
);
538 id_priv
->cma_dev
= NULL
;
542 static inline struct sockaddr
*cma_src_addr(struct rdma_id_private
*id_priv
)
544 return (struct sockaddr
*) &id_priv
->id
.route
.addr
.src_addr
;
547 static inline struct sockaddr
*cma_dst_addr(struct rdma_id_private
*id_priv
)
549 return (struct sockaddr
*) &id_priv
->id
.route
.addr
.dst_addr
;
552 static inline unsigned short cma_family(struct rdma_id_private
*id_priv
)
554 return id_priv
->id
.route
.addr
.src_addr
.ss_family
;
557 static int cma_set_qkey(struct rdma_id_private
*id_priv
, u32 qkey
)
559 struct ib_sa_mcmember_rec rec
;
563 if (qkey
&& id_priv
->qkey
!= qkey
)
569 id_priv
->qkey
= qkey
;
573 switch (id_priv
->id
.ps
) {
576 id_priv
->qkey
= RDMA_UDP_QKEY
;
579 ib_addr_get_mgid(&id_priv
->id
.route
.addr
.dev_addr
, &rec
.mgid
);
580 ret
= ib_sa_get_mcmember_rec(id_priv
->id
.device
,
581 id_priv
->id
.port_num
, &rec
.mgid
,
584 id_priv
->qkey
= be32_to_cpu(rec
.qkey
);
592 static void cma_translate_ib(struct sockaddr_ib
*sib
, struct rdma_dev_addr
*dev_addr
)
594 dev_addr
->dev_type
= ARPHRD_INFINIBAND
;
595 rdma_addr_set_sgid(dev_addr
, (union ib_gid
*) &sib
->sib_addr
);
596 ib_addr_set_pkey(dev_addr
, ntohs(sib
->sib_pkey
));
599 static int cma_translate_addr(struct sockaddr
*addr
, struct rdma_dev_addr
*dev_addr
)
603 if (addr
->sa_family
!= AF_IB
) {
604 ret
= rdma_translate_ip(addr
, dev_addr
, NULL
);
606 cma_translate_ib((struct sockaddr_ib
*) addr
, dev_addr
);
613 static inline int cma_validate_port(struct ib_device
*device
, u8 port
,
614 enum ib_gid_type gid_type
,
615 union ib_gid
*gid
, int dev_type
,
619 struct net_device
*ndev
= NULL
;
621 if ((dev_type
== ARPHRD_INFINIBAND
) && !rdma_protocol_ib(device
, port
))
624 if ((dev_type
!= ARPHRD_INFINIBAND
) && rdma_protocol_ib(device
, port
))
627 if (dev_type
== ARPHRD_ETHER
&& rdma_protocol_roce(device
, port
))
628 ndev
= dev_get_by_index(&init_net
, bound_if_index
);
630 gid_type
= IB_GID_TYPE_IB
;
633 ret
= ib_find_cached_gid_by_port(device
, gid
, gid_type
, port
,
642 static int cma_acquire_dev(struct rdma_id_private
*id_priv
,
643 struct rdma_id_private
*listen_id_priv
)
645 struct rdma_dev_addr
*dev_addr
= &id_priv
->id
.route
.addr
.dev_addr
;
646 struct cma_device
*cma_dev
;
647 union ib_gid gid
, iboe_gid
, *gidp
;
651 if (dev_addr
->dev_type
!= ARPHRD_INFINIBAND
&&
652 id_priv
->id
.ps
== RDMA_PS_IPOIB
)
656 rdma_ip2gid((struct sockaddr
*)&id_priv
->id
.route
.addr
.src_addr
,
659 memcpy(&gid
, dev_addr
->src_dev_addr
+
660 rdma_addr_gid_offset(dev_addr
), sizeof gid
);
662 if (listen_id_priv
) {
663 cma_dev
= listen_id_priv
->cma_dev
;
664 port
= listen_id_priv
->id
.port_num
;
665 gidp
= rdma_protocol_roce(cma_dev
->device
, port
) ?
668 ret
= cma_validate_port(cma_dev
->device
, port
,
669 rdma_protocol_ib(cma_dev
->device
, port
) ?
671 listen_id_priv
->gid_type
, gidp
,
673 dev_addr
->bound_dev_if
);
675 id_priv
->id
.port_num
= port
;
680 list_for_each_entry(cma_dev
, &dev_list
, list
) {
681 for (port
= 1; port
<= cma_dev
->device
->phys_port_cnt
; ++port
) {
682 if (listen_id_priv
&&
683 listen_id_priv
->cma_dev
== cma_dev
&&
684 listen_id_priv
->id
.port_num
== port
)
687 gidp
= rdma_protocol_roce(cma_dev
->device
, port
) ?
690 ret
= cma_validate_port(cma_dev
->device
, port
,
691 rdma_protocol_ib(cma_dev
->device
, port
) ?
693 cma_dev
->default_gid_type
[port
- 1],
694 gidp
, dev_addr
->dev_type
,
695 dev_addr
->bound_dev_if
);
697 id_priv
->id
.port_num
= port
;
705 cma_attach_to_dev(id_priv
, cma_dev
);
712 * Select the source IB device and address to reach the destination IB address.
714 static int cma_resolve_ib_dev(struct rdma_id_private
*id_priv
)
716 struct cma_device
*cma_dev
, *cur_dev
;
717 struct sockaddr_ib
*addr
;
718 union ib_gid gid
, sgid
, *dgid
;
721 enum ib_port_state port_state
;
725 addr
= (struct sockaddr_ib
*) cma_dst_addr(id_priv
);
726 dgid
= (union ib_gid
*) &addr
->sib_addr
;
727 pkey
= ntohs(addr
->sib_pkey
);
729 list_for_each_entry(cur_dev
, &dev_list
, list
) {
730 for (p
= 1; p
<= cur_dev
->device
->phys_port_cnt
; ++p
) {
731 if (!rdma_cap_af_ib(cur_dev
->device
, p
))
734 if (ib_find_cached_pkey(cur_dev
->device
, p
, pkey
, &index
))
737 if (ib_get_cached_port_state(cur_dev
->device
, p
, &port_state
))
739 for (i
= 0; !ib_get_cached_gid(cur_dev
->device
, p
, i
,
742 if (!memcmp(&gid
, dgid
, sizeof(gid
))) {
745 id_priv
->id
.port_num
= p
;
749 if (!cma_dev
&& (gid
.global
.subnet_prefix
==
750 dgid
->global
.subnet_prefix
) &&
751 port_state
== IB_PORT_ACTIVE
) {
754 id_priv
->id
.port_num
= p
;
764 cma_attach_to_dev(id_priv
, cma_dev
);
765 addr
= (struct sockaddr_ib
*) cma_src_addr(id_priv
);
766 memcpy(&addr
->sib_addr
, &sgid
, sizeof sgid
);
767 cma_translate_ib(addr
, &id_priv
->id
.route
.addr
.dev_addr
);
771 static void cma_deref_id(struct rdma_id_private
*id_priv
)
773 if (atomic_dec_and_test(&id_priv
->refcount
))
774 complete(&id_priv
->comp
);
777 struct rdma_cm_id
*rdma_create_id(struct net
*net
,
778 rdma_cm_event_handler event_handler
,
779 void *context
, enum rdma_port_space ps
,
780 enum ib_qp_type qp_type
)
782 struct rdma_id_private
*id_priv
;
784 id_priv
= kzalloc(sizeof *id_priv
, GFP_KERNEL
);
786 return ERR_PTR(-ENOMEM
);
788 id_priv
->owner
= task_pid_nr(current
);
789 id_priv
->state
= RDMA_CM_IDLE
;
790 id_priv
->id
.context
= context
;
791 id_priv
->id
.event_handler
= event_handler
;
793 id_priv
->id
.qp_type
= qp_type
;
794 id_priv
->tos_set
= false;
795 spin_lock_init(&id_priv
->lock
);
796 mutex_init(&id_priv
->qp_mutex
);
797 init_completion(&id_priv
->comp
);
798 atomic_set(&id_priv
->refcount
, 1);
799 mutex_init(&id_priv
->handler_mutex
);
800 INIT_LIST_HEAD(&id_priv
->listen_list
);
801 INIT_LIST_HEAD(&id_priv
->mc_list
);
802 get_random_bytes(&id_priv
->seq_num
, sizeof id_priv
->seq_num
);
803 id_priv
->id
.route
.addr
.dev_addr
.net
= get_net(net
);
807 EXPORT_SYMBOL(rdma_create_id
);
809 static int cma_init_ud_qp(struct rdma_id_private
*id_priv
, struct ib_qp
*qp
)
811 struct ib_qp_attr qp_attr
;
812 int qp_attr_mask
, ret
;
814 qp_attr
.qp_state
= IB_QPS_INIT
;
815 ret
= rdma_init_qp_attr(&id_priv
->id
, &qp_attr
, &qp_attr_mask
);
819 ret
= ib_modify_qp(qp
, &qp_attr
, qp_attr_mask
);
823 qp_attr
.qp_state
= IB_QPS_RTR
;
824 ret
= ib_modify_qp(qp
, &qp_attr
, IB_QP_STATE
);
828 qp_attr
.qp_state
= IB_QPS_RTS
;
830 ret
= ib_modify_qp(qp
, &qp_attr
, IB_QP_STATE
| IB_QP_SQ_PSN
);
835 static int cma_init_conn_qp(struct rdma_id_private
*id_priv
, struct ib_qp
*qp
)
837 struct ib_qp_attr qp_attr
;
838 int qp_attr_mask
, ret
;
840 qp_attr
.qp_state
= IB_QPS_INIT
;
841 ret
= rdma_init_qp_attr(&id_priv
->id
, &qp_attr
, &qp_attr_mask
);
845 return ib_modify_qp(qp
, &qp_attr
, qp_attr_mask
);
848 int rdma_create_qp(struct rdma_cm_id
*id
, struct ib_pd
*pd
,
849 struct ib_qp_init_attr
*qp_init_attr
)
851 struct rdma_id_private
*id_priv
;
855 id_priv
= container_of(id
, struct rdma_id_private
, id
);
856 if (id
->device
!= pd
->device
)
859 qp_init_attr
->port_num
= id
->port_num
;
860 qp
= ib_create_qp(pd
, qp_init_attr
);
864 if (id
->qp_type
== IB_QPT_UD
)
865 ret
= cma_init_ud_qp(id_priv
, qp
);
867 ret
= cma_init_conn_qp(id_priv
, qp
);
872 id_priv
->qp_num
= qp
->qp_num
;
873 id_priv
->srq
= (qp
->srq
!= NULL
);
879 EXPORT_SYMBOL(rdma_create_qp
);
881 void rdma_destroy_qp(struct rdma_cm_id
*id
)
883 struct rdma_id_private
*id_priv
;
885 id_priv
= container_of(id
, struct rdma_id_private
, id
);
886 mutex_lock(&id_priv
->qp_mutex
);
887 ib_destroy_qp(id_priv
->id
.qp
);
888 id_priv
->id
.qp
= NULL
;
889 mutex_unlock(&id_priv
->qp_mutex
);
891 EXPORT_SYMBOL(rdma_destroy_qp
);
893 static int cma_modify_qp_rtr(struct rdma_id_private
*id_priv
,
894 struct rdma_conn_param
*conn_param
)
896 struct ib_qp_attr qp_attr
;
897 int qp_attr_mask
, ret
;
900 mutex_lock(&id_priv
->qp_mutex
);
901 if (!id_priv
->id
.qp
) {
906 /* Need to update QP attributes from default values. */
907 qp_attr
.qp_state
= IB_QPS_INIT
;
908 ret
= rdma_init_qp_attr(&id_priv
->id
, &qp_attr
, &qp_attr_mask
);
912 ret
= ib_modify_qp(id_priv
->id
.qp
, &qp_attr
, qp_attr_mask
);
916 qp_attr
.qp_state
= IB_QPS_RTR
;
917 ret
= rdma_init_qp_attr(&id_priv
->id
, &qp_attr
, &qp_attr_mask
);
921 ret
= ib_query_gid(id_priv
->id
.device
, id_priv
->id
.port_num
,
922 rdma_ah_read_grh(&qp_attr
.ah_attr
)->sgid_index
,
927 BUG_ON(id_priv
->cma_dev
->device
!= id_priv
->id
.device
);
930 qp_attr
.max_dest_rd_atomic
= conn_param
->responder_resources
;
931 ret
= ib_modify_qp(id_priv
->id
.qp
, &qp_attr
, qp_attr_mask
);
933 mutex_unlock(&id_priv
->qp_mutex
);
937 static int cma_modify_qp_rts(struct rdma_id_private
*id_priv
,
938 struct rdma_conn_param
*conn_param
)
940 struct ib_qp_attr qp_attr
;
941 int qp_attr_mask
, ret
;
943 mutex_lock(&id_priv
->qp_mutex
);
944 if (!id_priv
->id
.qp
) {
949 qp_attr
.qp_state
= IB_QPS_RTS
;
950 ret
= rdma_init_qp_attr(&id_priv
->id
, &qp_attr
, &qp_attr_mask
);
955 qp_attr
.max_rd_atomic
= conn_param
->initiator_depth
;
956 ret
= ib_modify_qp(id_priv
->id
.qp
, &qp_attr
, qp_attr_mask
);
958 mutex_unlock(&id_priv
->qp_mutex
);
962 static int cma_modify_qp_err(struct rdma_id_private
*id_priv
)
964 struct ib_qp_attr qp_attr
;
967 mutex_lock(&id_priv
->qp_mutex
);
968 if (!id_priv
->id
.qp
) {
973 qp_attr
.qp_state
= IB_QPS_ERR
;
974 ret
= ib_modify_qp(id_priv
->id
.qp
, &qp_attr
, IB_QP_STATE
);
976 mutex_unlock(&id_priv
->qp_mutex
);
980 static int cma_ib_init_qp_attr(struct rdma_id_private
*id_priv
,
981 struct ib_qp_attr
*qp_attr
, int *qp_attr_mask
)
983 struct rdma_dev_addr
*dev_addr
= &id_priv
->id
.route
.addr
.dev_addr
;
987 if (rdma_cap_eth_ah(id_priv
->id
.device
, id_priv
->id
.port_num
))
990 pkey
= ib_addr_get_pkey(dev_addr
);
992 ret
= ib_find_cached_pkey(id_priv
->id
.device
, id_priv
->id
.port_num
,
993 pkey
, &qp_attr
->pkey_index
);
997 qp_attr
->port_num
= id_priv
->id
.port_num
;
998 *qp_attr_mask
= IB_QP_STATE
| IB_QP_PKEY_INDEX
| IB_QP_PORT
;
1000 if (id_priv
->id
.qp_type
== IB_QPT_UD
) {
1001 ret
= cma_set_qkey(id_priv
, 0);
1005 qp_attr
->qkey
= id_priv
->qkey
;
1006 *qp_attr_mask
|= IB_QP_QKEY
;
1008 qp_attr
->qp_access_flags
= 0;
1009 *qp_attr_mask
|= IB_QP_ACCESS_FLAGS
;
1014 int rdma_init_qp_attr(struct rdma_cm_id
*id
, struct ib_qp_attr
*qp_attr
,
1017 struct rdma_id_private
*id_priv
;
1020 id_priv
= container_of(id
, struct rdma_id_private
, id
);
1021 if (rdma_cap_ib_cm(id
->device
, id
->port_num
)) {
1022 if (!id_priv
->cm_id
.ib
|| (id_priv
->id
.qp_type
== IB_QPT_UD
))
1023 ret
= cma_ib_init_qp_attr(id_priv
, qp_attr
, qp_attr_mask
);
1025 ret
= ib_cm_init_qp_attr(id_priv
->cm_id
.ib
, qp_attr
,
1028 if (qp_attr
->qp_state
== IB_QPS_RTR
)
1029 qp_attr
->rq_psn
= id_priv
->seq_num
;
1030 } else if (rdma_cap_iw_cm(id
->device
, id
->port_num
)) {
1031 if (!id_priv
->cm_id
.iw
) {
1032 qp_attr
->qp_access_flags
= 0;
1033 *qp_attr_mask
= IB_QP_STATE
| IB_QP_ACCESS_FLAGS
;
1035 ret
= iw_cm_init_qp_attr(id_priv
->cm_id
.iw
, qp_attr
,
1037 qp_attr
->port_num
= id_priv
->id
.port_num
;
1038 *qp_attr_mask
|= IB_QP_PORT
;
1044 EXPORT_SYMBOL(rdma_init_qp_attr
);
1046 static inline int cma_zero_addr(struct sockaddr
*addr
)
1048 switch (addr
->sa_family
) {
1050 return ipv4_is_zeronet(((struct sockaddr_in
*)addr
)->sin_addr
.s_addr
);
1052 return ipv6_addr_any(&((struct sockaddr_in6
*) addr
)->sin6_addr
);
1054 return ib_addr_any(&((struct sockaddr_ib
*) addr
)->sib_addr
);
1060 static inline int cma_loopback_addr(struct sockaddr
*addr
)
1062 switch (addr
->sa_family
) {
1064 return ipv4_is_loopback(((struct sockaddr_in
*) addr
)->sin_addr
.s_addr
);
1066 return ipv6_addr_loopback(&((struct sockaddr_in6
*) addr
)->sin6_addr
);
1068 return ib_addr_loopback(&((struct sockaddr_ib
*) addr
)->sib_addr
);
1074 static inline int cma_any_addr(struct sockaddr
*addr
)
1076 return cma_zero_addr(addr
) || cma_loopback_addr(addr
);
1079 static int cma_addr_cmp(struct sockaddr
*src
, struct sockaddr
*dst
)
1081 if (src
->sa_family
!= dst
->sa_family
)
1084 switch (src
->sa_family
) {
1086 return ((struct sockaddr_in
*) src
)->sin_addr
.s_addr
!=
1087 ((struct sockaddr_in
*) dst
)->sin_addr
.s_addr
;
1089 return ipv6_addr_cmp(&((struct sockaddr_in6
*) src
)->sin6_addr
,
1090 &((struct sockaddr_in6
*) dst
)->sin6_addr
);
1092 return ib_addr_cmp(&((struct sockaddr_ib
*) src
)->sib_addr
,
1093 &((struct sockaddr_ib
*) dst
)->sib_addr
);
1097 static __be16
cma_port(struct sockaddr
*addr
)
1099 struct sockaddr_ib
*sib
;
1101 switch (addr
->sa_family
) {
1103 return ((struct sockaddr_in
*) addr
)->sin_port
;
1105 return ((struct sockaddr_in6
*) addr
)->sin6_port
;
1107 sib
= (struct sockaddr_ib
*) addr
;
1108 return htons((u16
) (be64_to_cpu(sib
->sib_sid
) &
1109 be64_to_cpu(sib
->sib_sid_mask
)));
1115 static inline int cma_any_port(struct sockaddr
*addr
)
1117 return !cma_port(addr
);
1120 static void cma_save_ib_info(struct sockaddr
*src_addr
,
1121 struct sockaddr
*dst_addr
,
1122 struct rdma_cm_id
*listen_id
,
1123 struct sa_path_rec
*path
)
1125 struct sockaddr_ib
*listen_ib
, *ib
;
1127 listen_ib
= (struct sockaddr_ib
*) &listen_id
->route
.addr
.src_addr
;
1129 ib
= (struct sockaddr_ib
*)src_addr
;
1130 ib
->sib_family
= AF_IB
;
1132 ib
->sib_pkey
= path
->pkey
;
1133 ib
->sib_flowinfo
= path
->flow_label
;
1134 memcpy(&ib
->sib_addr
, &path
->sgid
, 16);
1135 ib
->sib_sid
= path
->service_id
;
1136 ib
->sib_scope_id
= 0;
1138 ib
->sib_pkey
= listen_ib
->sib_pkey
;
1139 ib
->sib_flowinfo
= listen_ib
->sib_flowinfo
;
1140 ib
->sib_addr
= listen_ib
->sib_addr
;
1141 ib
->sib_sid
= listen_ib
->sib_sid
;
1142 ib
->sib_scope_id
= listen_ib
->sib_scope_id
;
1144 ib
->sib_sid_mask
= cpu_to_be64(0xffffffffffffffffULL
);
1147 ib
= (struct sockaddr_ib
*)dst_addr
;
1148 ib
->sib_family
= AF_IB
;
1150 ib
->sib_pkey
= path
->pkey
;
1151 ib
->sib_flowinfo
= path
->flow_label
;
1152 memcpy(&ib
->sib_addr
, &path
->dgid
, 16);
1157 static void cma_save_ip4_info(struct sockaddr_in
*src_addr
,
1158 struct sockaddr_in
*dst_addr
,
1159 struct cma_hdr
*hdr
,
1163 *src_addr
= (struct sockaddr_in
) {
1164 .sin_family
= AF_INET
,
1165 .sin_addr
.s_addr
= hdr
->dst_addr
.ip4
.addr
,
1166 .sin_port
= local_port
,
1171 *dst_addr
= (struct sockaddr_in
) {
1172 .sin_family
= AF_INET
,
1173 .sin_addr
.s_addr
= hdr
->src_addr
.ip4
.addr
,
1174 .sin_port
= hdr
->port
,
1179 static void cma_save_ip6_info(struct sockaddr_in6
*src_addr
,
1180 struct sockaddr_in6
*dst_addr
,
1181 struct cma_hdr
*hdr
,
1185 *src_addr
= (struct sockaddr_in6
) {
1186 .sin6_family
= AF_INET6
,
1187 .sin6_addr
= hdr
->dst_addr
.ip6
,
1188 .sin6_port
= local_port
,
1193 *dst_addr
= (struct sockaddr_in6
) {
1194 .sin6_family
= AF_INET6
,
1195 .sin6_addr
= hdr
->src_addr
.ip6
,
1196 .sin6_port
= hdr
->port
,
1201 static u16
cma_port_from_service_id(__be64 service_id
)
1203 return (u16
)be64_to_cpu(service_id
);
1206 static int cma_save_ip_info(struct sockaddr
*src_addr
,
1207 struct sockaddr
*dst_addr
,
1208 struct ib_cm_event
*ib_event
,
1211 struct cma_hdr
*hdr
;
1214 hdr
= ib_event
->private_data
;
1215 if (hdr
->cma_version
!= CMA_VERSION
)
1218 port
= htons(cma_port_from_service_id(service_id
));
1220 switch (cma_get_ip_ver(hdr
)) {
1222 cma_save_ip4_info((struct sockaddr_in
*)src_addr
,
1223 (struct sockaddr_in
*)dst_addr
, hdr
, port
);
1226 cma_save_ip6_info((struct sockaddr_in6
*)src_addr
,
1227 (struct sockaddr_in6
*)dst_addr
, hdr
, port
);
1230 return -EAFNOSUPPORT
;
1236 static int cma_save_net_info(struct sockaddr
*src_addr
,
1237 struct sockaddr
*dst_addr
,
1238 struct rdma_cm_id
*listen_id
,
1239 struct ib_cm_event
*ib_event
,
1240 sa_family_t sa_family
, __be64 service_id
)
1242 if (sa_family
== AF_IB
) {
1243 if (ib_event
->event
== IB_CM_REQ_RECEIVED
)
1244 cma_save_ib_info(src_addr
, dst_addr
, listen_id
,
1245 ib_event
->param
.req_rcvd
.primary_path
);
1246 else if (ib_event
->event
== IB_CM_SIDR_REQ_RECEIVED
)
1247 cma_save_ib_info(src_addr
, dst_addr
, listen_id
, NULL
);
1251 return cma_save_ip_info(src_addr
, dst_addr
, ib_event
, service_id
);
1254 static int cma_save_req_info(const struct ib_cm_event
*ib_event
,
1255 struct cma_req_info
*req
)
1257 const struct ib_cm_req_event_param
*req_param
=
1258 &ib_event
->param
.req_rcvd
;
1259 const struct ib_cm_sidr_req_event_param
*sidr_param
=
1260 &ib_event
->param
.sidr_req_rcvd
;
1262 switch (ib_event
->event
) {
1263 case IB_CM_REQ_RECEIVED
:
1264 req
->device
= req_param
->listen_id
->device
;
1265 req
->port
= req_param
->port
;
1266 memcpy(&req
->local_gid
, &req_param
->primary_path
->sgid
,
1267 sizeof(req
->local_gid
));
1268 req
->has_gid
= true;
1269 req
->service_id
= req_param
->primary_path
->service_id
;
1270 req
->pkey
= be16_to_cpu(req_param
->primary_path
->pkey
);
1271 if (req
->pkey
!= req_param
->bth_pkey
)
1272 pr_warn_ratelimited("RDMA CMA: got different BTH P_Key (0x%x) and primary path P_Key (0x%x)\n"
1273 "RDMA CMA: in the future this may cause the request to be dropped\n",
1274 req_param
->bth_pkey
, req
->pkey
);
1276 case IB_CM_SIDR_REQ_RECEIVED
:
1277 req
->device
= sidr_param
->listen_id
->device
;
1278 req
->port
= sidr_param
->port
;
1279 req
->has_gid
= false;
1280 req
->service_id
= sidr_param
->service_id
;
1281 req
->pkey
= sidr_param
->pkey
;
1282 if (req
->pkey
!= sidr_param
->bth_pkey
)
1283 pr_warn_ratelimited("RDMA CMA: got different BTH P_Key (0x%x) and SIDR request payload P_Key (0x%x)\n"
1284 "RDMA CMA: in the future this may cause the request to be dropped\n",
1285 sidr_param
->bth_pkey
, req
->pkey
);
1294 static bool validate_ipv4_net_dev(struct net_device
*net_dev
,
1295 const struct sockaddr_in
*dst_addr
,
1296 const struct sockaddr_in
*src_addr
)
1298 __be32 daddr
= dst_addr
->sin_addr
.s_addr
,
1299 saddr
= src_addr
->sin_addr
.s_addr
;
1300 struct fib_result res
;
1305 if (ipv4_is_multicast(saddr
) || ipv4_is_lbcast(saddr
) ||
1306 ipv4_is_lbcast(daddr
) || ipv4_is_zeronet(saddr
) ||
1307 ipv4_is_zeronet(daddr
) || ipv4_is_loopback(daddr
) ||
1308 ipv4_is_loopback(saddr
))
1311 memset(&fl4
, 0, sizeof(fl4
));
1312 fl4
.flowi4_iif
= net_dev
->ifindex
;
1317 err
= fib_lookup(dev_net(net_dev
), &fl4
, &res
, 0);
1318 ret
= err
== 0 && FIB_RES_DEV(res
) == net_dev
;
1324 static bool validate_ipv6_net_dev(struct net_device
*net_dev
,
1325 const struct sockaddr_in6
*dst_addr
,
1326 const struct sockaddr_in6
*src_addr
)
1328 #if IS_ENABLED(CONFIG_IPV6)
1329 const int strict
= ipv6_addr_type(&dst_addr
->sin6_addr
) &
1330 IPV6_ADDR_LINKLOCAL
;
1331 struct rt6_info
*rt
= rt6_lookup(dev_net(net_dev
), &dst_addr
->sin6_addr
,
1332 &src_addr
->sin6_addr
, net_dev
->ifindex
,
1339 ret
= rt
->rt6i_idev
->dev
== net_dev
;
1348 static bool validate_net_dev(struct net_device
*net_dev
,
1349 const struct sockaddr
*daddr
,
1350 const struct sockaddr
*saddr
)
1352 const struct sockaddr_in
*daddr4
= (const struct sockaddr_in
*)daddr
;
1353 const struct sockaddr_in
*saddr4
= (const struct sockaddr_in
*)saddr
;
1354 const struct sockaddr_in6
*daddr6
= (const struct sockaddr_in6
*)daddr
;
1355 const struct sockaddr_in6
*saddr6
= (const struct sockaddr_in6
*)saddr
;
1357 switch (daddr
->sa_family
) {
1359 return saddr
->sa_family
== AF_INET
&&
1360 validate_ipv4_net_dev(net_dev
, daddr4
, saddr4
);
1363 return saddr
->sa_family
== AF_INET6
&&
1364 validate_ipv6_net_dev(net_dev
, daddr6
, saddr6
);
1371 static struct net_device
*cma_get_net_dev(struct ib_cm_event
*ib_event
,
1372 const struct cma_req_info
*req
)
1374 struct sockaddr_storage listen_addr_storage
, src_addr_storage
;
1375 struct sockaddr
*listen_addr
= (struct sockaddr
*)&listen_addr_storage
,
1376 *src_addr
= (struct sockaddr
*)&src_addr_storage
;
1377 struct net_device
*net_dev
;
1378 const union ib_gid
*gid
= req
->has_gid
? &req
->local_gid
: NULL
;
1381 err
= cma_save_ip_info(listen_addr
, src_addr
, ib_event
,
1384 return ERR_PTR(err
);
1386 net_dev
= ib_get_net_dev_by_params(req
->device
, req
->port
, req
->pkey
,
1389 return ERR_PTR(-ENODEV
);
1391 if (!validate_net_dev(net_dev
, listen_addr
, src_addr
)) {
1393 return ERR_PTR(-EHOSTUNREACH
);
1399 static enum rdma_port_space
rdma_ps_from_service_id(__be64 service_id
)
1401 return (be64_to_cpu(service_id
) >> 16) & 0xffff;
1404 static bool cma_match_private_data(struct rdma_id_private
*id_priv
,
1405 const struct cma_hdr
*hdr
)
1407 struct sockaddr
*addr
= cma_src_addr(id_priv
);
1409 struct in6_addr ip6_addr
;
1411 if (cma_any_addr(addr
) && !id_priv
->afonly
)
1414 switch (addr
->sa_family
) {
1416 ip4_addr
= ((struct sockaddr_in
*)addr
)->sin_addr
.s_addr
;
1417 if (cma_get_ip_ver(hdr
) != 4)
1419 if (!cma_any_addr(addr
) &&
1420 hdr
->dst_addr
.ip4
.addr
!= ip4_addr
)
1424 ip6_addr
= ((struct sockaddr_in6
*)addr
)->sin6_addr
;
1425 if (cma_get_ip_ver(hdr
) != 6)
1427 if (!cma_any_addr(addr
) &&
1428 memcmp(&hdr
->dst_addr
.ip6
, &ip6_addr
, sizeof(ip6_addr
)))
1440 static bool cma_protocol_roce_dev_port(struct ib_device
*device
, int port_num
)
1442 enum rdma_link_layer ll
= rdma_port_get_link_layer(device
, port_num
);
1443 enum rdma_transport_type transport
=
1444 rdma_node_get_transport(device
->node_type
);
1446 return ll
== IB_LINK_LAYER_ETHERNET
&& transport
== RDMA_TRANSPORT_IB
;
1449 static bool cma_protocol_roce(const struct rdma_cm_id
*id
)
1451 struct ib_device
*device
= id
->device
;
1452 const int port_num
= id
->port_num
?: rdma_start_port(device
);
1454 return cma_protocol_roce_dev_port(device
, port_num
);
1457 static bool cma_match_net_dev(const struct rdma_cm_id
*id
,
1458 const struct net_device
*net_dev
,
1461 const struct rdma_addr
*addr
= &id
->route
.addr
;
1464 /* This request is an AF_IB request or a RoCE request */
1465 return (!id
->port_num
|| id
->port_num
== port_num
) &&
1466 (addr
->src_addr
.ss_family
== AF_IB
||
1467 cma_protocol_roce_dev_port(id
->device
, port_num
));
1469 return !addr
->dev_addr
.bound_dev_if
||
1470 (net_eq(dev_net(net_dev
), addr
->dev_addr
.net
) &&
1471 addr
->dev_addr
.bound_dev_if
== net_dev
->ifindex
);
1474 static struct rdma_id_private
*cma_find_listener(
1475 const struct rdma_bind_list
*bind_list
,
1476 const struct ib_cm_id
*cm_id
,
1477 const struct ib_cm_event
*ib_event
,
1478 const struct cma_req_info
*req
,
1479 const struct net_device
*net_dev
)
1481 struct rdma_id_private
*id_priv
, *id_priv_dev
;
1484 return ERR_PTR(-EINVAL
);
1486 hlist_for_each_entry(id_priv
, &bind_list
->owners
, node
) {
1487 if (cma_match_private_data(id_priv
, ib_event
->private_data
)) {
1488 if (id_priv
->id
.device
== cm_id
->device
&&
1489 cma_match_net_dev(&id_priv
->id
, net_dev
, req
->port
))
1491 list_for_each_entry(id_priv_dev
,
1492 &id_priv
->listen_list
,
1494 if (id_priv_dev
->id
.device
== cm_id
->device
&&
1495 cma_match_net_dev(&id_priv_dev
->id
, net_dev
, req
->port
))
1501 return ERR_PTR(-EINVAL
);
1504 static struct rdma_id_private
*cma_id_from_event(struct ib_cm_id
*cm_id
,
1505 struct ib_cm_event
*ib_event
,
1506 struct net_device
**net_dev
)
1508 struct cma_req_info req
;
1509 struct rdma_bind_list
*bind_list
;
1510 struct rdma_id_private
*id_priv
;
1513 err
= cma_save_req_info(ib_event
, &req
);
1515 return ERR_PTR(err
);
1517 *net_dev
= cma_get_net_dev(ib_event
, &req
);
1518 if (IS_ERR(*net_dev
)) {
1519 if (PTR_ERR(*net_dev
) == -EAFNOSUPPORT
) {
1520 /* Assuming the protocol is AF_IB */
1522 } else if (cma_protocol_roce_dev_port(req
.device
, req
.port
)) {
1523 /* TODO find the net dev matching the request parameters
1524 * through the RoCE GID table */
1527 return ERR_CAST(*net_dev
);
1531 bind_list
= cma_ps_find(*net_dev
? dev_net(*net_dev
) : &init_net
,
1532 rdma_ps_from_service_id(req
.service_id
),
1533 cma_port_from_service_id(req
.service_id
));
1534 id_priv
= cma_find_listener(bind_list
, cm_id
, ib_event
, &req
, *net_dev
);
1535 if (IS_ERR(id_priv
) && *net_dev
) {
1543 static inline int cma_user_data_offset(struct rdma_id_private
*id_priv
)
1545 return cma_family(id_priv
) == AF_IB
? 0 : sizeof(struct cma_hdr
);
1548 static void cma_cancel_route(struct rdma_id_private
*id_priv
)
1550 if (rdma_cap_ib_sa(id_priv
->id
.device
, id_priv
->id
.port_num
)) {
1552 ib_sa_cancel_query(id_priv
->query_id
, id_priv
->query
);
1556 static void cma_cancel_listens(struct rdma_id_private
*id_priv
)
1558 struct rdma_id_private
*dev_id_priv
;
1561 * Remove from listen_any_list to prevent added devices from spawning
1562 * additional listen requests.
1565 list_del(&id_priv
->list
);
1567 while (!list_empty(&id_priv
->listen_list
)) {
1568 dev_id_priv
= list_entry(id_priv
->listen_list
.next
,
1569 struct rdma_id_private
, listen_list
);
1570 /* sync with device removal to avoid duplicate destruction */
1571 list_del_init(&dev_id_priv
->list
);
1572 list_del(&dev_id_priv
->listen_list
);
1573 mutex_unlock(&lock
);
1575 rdma_destroy_id(&dev_id_priv
->id
);
1578 mutex_unlock(&lock
);
1581 static void cma_cancel_operation(struct rdma_id_private
*id_priv
,
1582 enum rdma_cm_state state
)
1585 case RDMA_CM_ADDR_QUERY
:
1586 rdma_addr_cancel(&id_priv
->id
.route
.addr
.dev_addr
);
1588 case RDMA_CM_ROUTE_QUERY
:
1589 cma_cancel_route(id_priv
);
1591 case RDMA_CM_LISTEN
:
1592 if (cma_any_addr(cma_src_addr(id_priv
)) && !id_priv
->cma_dev
)
1593 cma_cancel_listens(id_priv
);
1600 static void cma_release_port(struct rdma_id_private
*id_priv
)
1602 struct rdma_bind_list
*bind_list
= id_priv
->bind_list
;
1603 struct net
*net
= id_priv
->id
.route
.addr
.dev_addr
.net
;
1609 hlist_del(&id_priv
->node
);
1610 if (hlist_empty(&bind_list
->owners
)) {
1611 cma_ps_remove(net
, bind_list
->ps
, bind_list
->port
);
1614 mutex_unlock(&lock
);
1617 static void cma_leave_mc_groups(struct rdma_id_private
*id_priv
)
1619 struct cma_multicast
*mc
;
1621 while (!list_empty(&id_priv
->mc_list
)) {
1622 mc
= container_of(id_priv
->mc_list
.next
,
1623 struct cma_multicast
, list
);
1624 list_del(&mc
->list
);
1625 if (rdma_cap_ib_mcast(id_priv
->cma_dev
->device
,
1626 id_priv
->id
.port_num
)) {
1627 ib_sa_free_multicast(mc
->multicast
.ib
);
1630 if (mc
->igmp_joined
) {
1631 struct rdma_dev_addr
*dev_addr
=
1632 &id_priv
->id
.route
.addr
.dev_addr
;
1633 struct net_device
*ndev
= NULL
;
1635 if (dev_addr
->bound_dev_if
)
1636 ndev
= dev_get_by_index(&init_net
,
1637 dev_addr
->bound_dev_if
);
1640 &mc
->multicast
.ib
->rec
.mgid
,
1645 kref_put(&mc
->mcref
, release_mc
);
1650 void rdma_destroy_id(struct rdma_cm_id
*id
)
1652 struct rdma_id_private
*id_priv
;
1653 enum rdma_cm_state state
;
1655 id_priv
= container_of(id
, struct rdma_id_private
, id
);
1656 state
= cma_exch(id_priv
, RDMA_CM_DESTROYING
);
1657 cma_cancel_operation(id_priv
, state
);
1660 * Wait for any active callback to finish. New callbacks will find
1661 * the id_priv state set to destroying and abort.
1663 mutex_lock(&id_priv
->handler_mutex
);
1664 mutex_unlock(&id_priv
->handler_mutex
);
1666 if (id_priv
->cma_dev
) {
1667 if (rdma_cap_ib_cm(id_priv
->id
.device
, 1)) {
1668 if (id_priv
->cm_id
.ib
)
1669 ib_destroy_cm_id(id_priv
->cm_id
.ib
);
1670 } else if (rdma_cap_iw_cm(id_priv
->id
.device
, 1)) {
1671 if (id_priv
->cm_id
.iw
)
1672 iw_destroy_cm_id(id_priv
->cm_id
.iw
);
1674 cma_leave_mc_groups(id_priv
);
1675 cma_release_dev(id_priv
);
1678 cma_release_port(id_priv
);
1679 cma_deref_id(id_priv
);
1680 wait_for_completion(&id_priv
->comp
);
1682 if (id_priv
->internal_id
)
1683 cma_deref_id(id_priv
->id
.context
);
1685 kfree(id_priv
->id
.route
.path_rec
);
1686 put_net(id_priv
->id
.route
.addr
.dev_addr
.net
);
1689 EXPORT_SYMBOL(rdma_destroy_id
);
1691 static int cma_rep_recv(struct rdma_id_private
*id_priv
)
1695 ret
= cma_modify_qp_rtr(id_priv
, NULL
);
1699 ret
= cma_modify_qp_rts(id_priv
, NULL
);
1703 ret
= ib_send_cm_rtu(id_priv
->cm_id
.ib
, NULL
, 0);
1709 pr_debug_ratelimited("RDMA CM: CONNECT_ERROR: failed to handle reply. status %d\n", ret
);
1710 cma_modify_qp_err(id_priv
);
1711 ib_send_cm_rej(id_priv
->cm_id
.ib
, IB_CM_REJ_CONSUMER_DEFINED
,
1716 static void cma_set_rep_event_data(struct rdma_cm_event
*event
,
1717 struct ib_cm_rep_event_param
*rep_data
,
1720 event
->param
.conn
.private_data
= private_data
;
1721 event
->param
.conn
.private_data_len
= IB_CM_REP_PRIVATE_DATA_SIZE
;
1722 event
->param
.conn
.responder_resources
= rep_data
->responder_resources
;
1723 event
->param
.conn
.initiator_depth
= rep_data
->initiator_depth
;
1724 event
->param
.conn
.flow_control
= rep_data
->flow_control
;
1725 event
->param
.conn
.rnr_retry_count
= rep_data
->rnr_retry_count
;
1726 event
->param
.conn
.srq
= rep_data
->srq
;
1727 event
->param
.conn
.qp_num
= rep_data
->remote_qpn
;
1730 static int cma_ib_handler(struct ib_cm_id
*cm_id
, struct ib_cm_event
*ib_event
)
1732 struct rdma_id_private
*id_priv
= cm_id
->context
;
1733 struct rdma_cm_event event
;
1736 mutex_lock(&id_priv
->handler_mutex
);
1737 if ((ib_event
->event
!= IB_CM_TIMEWAIT_EXIT
&&
1738 id_priv
->state
!= RDMA_CM_CONNECT
) ||
1739 (ib_event
->event
== IB_CM_TIMEWAIT_EXIT
&&
1740 id_priv
->state
!= RDMA_CM_DISCONNECT
))
1743 memset(&event
, 0, sizeof event
);
1744 switch (ib_event
->event
) {
1745 case IB_CM_REQ_ERROR
:
1746 case IB_CM_REP_ERROR
:
1747 event
.event
= RDMA_CM_EVENT_UNREACHABLE
;
1748 event
.status
= -ETIMEDOUT
;
1750 case IB_CM_REP_RECEIVED
:
1751 if (cma_comp(id_priv
, RDMA_CM_CONNECT
) &&
1752 (id_priv
->id
.qp_type
!= IB_QPT_UD
))
1753 ib_send_cm_mra(cm_id
, CMA_CM_MRA_SETTING
, NULL
, 0);
1754 if (id_priv
->id
.qp
) {
1755 event
.status
= cma_rep_recv(id_priv
);
1756 event
.event
= event
.status
? RDMA_CM_EVENT_CONNECT_ERROR
:
1757 RDMA_CM_EVENT_ESTABLISHED
;
1759 event
.event
= RDMA_CM_EVENT_CONNECT_RESPONSE
;
1761 cma_set_rep_event_data(&event
, &ib_event
->param
.rep_rcvd
,
1762 ib_event
->private_data
);
1764 case IB_CM_RTU_RECEIVED
:
1765 case IB_CM_USER_ESTABLISHED
:
1766 event
.event
= RDMA_CM_EVENT_ESTABLISHED
;
1768 case IB_CM_DREQ_ERROR
:
1769 event
.status
= -ETIMEDOUT
; /* fall through */
1770 case IB_CM_DREQ_RECEIVED
:
1771 case IB_CM_DREP_RECEIVED
:
1772 if (!cma_comp_exch(id_priv
, RDMA_CM_CONNECT
,
1773 RDMA_CM_DISCONNECT
))
1775 event
.event
= RDMA_CM_EVENT_DISCONNECTED
;
1777 case IB_CM_TIMEWAIT_EXIT
:
1778 event
.event
= RDMA_CM_EVENT_TIMEWAIT_EXIT
;
1780 case IB_CM_MRA_RECEIVED
:
1783 case IB_CM_REJ_RECEIVED
:
1784 pr_debug_ratelimited("RDMA CM: REJECTED: %s\n", rdma_reject_msg(&id_priv
->id
,
1785 ib_event
->param
.rej_rcvd
.reason
));
1786 cma_modify_qp_err(id_priv
);
1787 event
.status
= ib_event
->param
.rej_rcvd
.reason
;
1788 event
.event
= RDMA_CM_EVENT_REJECTED
;
1789 event
.param
.conn
.private_data
= ib_event
->private_data
;
1790 event
.param
.conn
.private_data_len
= IB_CM_REJ_PRIVATE_DATA_SIZE
;
1793 pr_err("RDMA CMA: unexpected IB CM event: %d\n",
1798 ret
= id_priv
->id
.event_handler(&id_priv
->id
, &event
);
1800 /* Destroy the CM ID by returning a non-zero value. */
1801 id_priv
->cm_id
.ib
= NULL
;
1802 cma_exch(id_priv
, RDMA_CM_DESTROYING
);
1803 mutex_unlock(&id_priv
->handler_mutex
);
1804 rdma_destroy_id(&id_priv
->id
);
1808 mutex_unlock(&id_priv
->handler_mutex
);
1812 static struct rdma_id_private
*cma_new_conn_id(struct rdma_cm_id
*listen_id
,
1813 struct ib_cm_event
*ib_event
,
1814 struct net_device
*net_dev
)
1816 struct rdma_id_private
*id_priv
;
1817 struct rdma_cm_id
*id
;
1818 struct rdma_route
*rt
;
1819 const sa_family_t ss_family
= listen_id
->route
.addr
.src_addr
.ss_family
;
1820 struct sa_path_rec
*path
= ib_event
->param
.req_rcvd
.primary_path
;
1821 const __be64 service_id
=
1822 ib_event
->param
.req_rcvd
.primary_path
->service_id
;
1825 id
= rdma_create_id(listen_id
->route
.addr
.dev_addr
.net
,
1826 listen_id
->event_handler
, listen_id
->context
,
1827 listen_id
->ps
, ib_event
->param
.req_rcvd
.qp_type
);
1831 id_priv
= container_of(id
, struct rdma_id_private
, id
);
1832 if (cma_save_net_info((struct sockaddr
*)&id
->route
.addr
.src_addr
,
1833 (struct sockaddr
*)&id
->route
.addr
.dst_addr
,
1834 listen_id
, ib_event
, ss_family
, service_id
))
1838 rt
->num_paths
= ib_event
->param
.req_rcvd
.alternate_path
? 2 : 1;
1839 rt
->path_rec
= kmalloc(sizeof *rt
->path_rec
* rt
->num_paths
,
1844 rt
->path_rec
[0] = *path
;
1845 if (rt
->num_paths
== 2)
1846 rt
->path_rec
[1] = *ib_event
->param
.req_rcvd
.alternate_path
;
1849 ret
= rdma_copy_addr(&rt
->addr
.dev_addr
, net_dev
, NULL
);
1853 if (!cma_protocol_roce(listen_id
) &&
1854 cma_any_addr(cma_src_addr(id_priv
))) {
1855 rt
->addr
.dev_addr
.dev_type
= ARPHRD_INFINIBAND
;
1856 rdma_addr_set_sgid(&rt
->addr
.dev_addr
, &rt
->path_rec
[0].sgid
);
1857 ib_addr_set_pkey(&rt
->addr
.dev_addr
, be16_to_cpu(rt
->path_rec
[0].pkey
));
1858 } else if (!cma_any_addr(cma_src_addr(id_priv
))) {
1859 ret
= cma_translate_addr(cma_src_addr(id_priv
), &rt
->addr
.dev_addr
);
1864 rdma_addr_set_dgid(&rt
->addr
.dev_addr
, &rt
->path_rec
[0].dgid
);
1866 id_priv
->state
= RDMA_CM_CONNECT
;
1870 rdma_destroy_id(id
);
1874 static struct rdma_id_private
*cma_new_udp_id(struct rdma_cm_id
*listen_id
,
1875 struct ib_cm_event
*ib_event
,
1876 struct net_device
*net_dev
)
1878 struct rdma_id_private
*id_priv
;
1879 struct rdma_cm_id
*id
;
1880 const sa_family_t ss_family
= listen_id
->route
.addr
.src_addr
.ss_family
;
1881 struct net
*net
= listen_id
->route
.addr
.dev_addr
.net
;
1884 id
= rdma_create_id(net
, listen_id
->event_handler
, listen_id
->context
,
1885 listen_id
->ps
, IB_QPT_UD
);
1889 id_priv
= container_of(id
, struct rdma_id_private
, id
);
1890 if (cma_save_net_info((struct sockaddr
*)&id
->route
.addr
.src_addr
,
1891 (struct sockaddr
*)&id
->route
.addr
.dst_addr
,
1892 listen_id
, ib_event
, ss_family
,
1893 ib_event
->param
.sidr_req_rcvd
.service_id
))
1897 ret
= rdma_copy_addr(&id
->route
.addr
.dev_addr
, net_dev
, NULL
);
1901 if (!cma_any_addr(cma_src_addr(id_priv
))) {
1902 ret
= cma_translate_addr(cma_src_addr(id_priv
),
1903 &id
->route
.addr
.dev_addr
);
1909 id_priv
->state
= RDMA_CM_CONNECT
;
1912 rdma_destroy_id(id
);
1916 static void cma_set_req_event_data(struct rdma_cm_event
*event
,
1917 struct ib_cm_req_event_param
*req_data
,
1918 void *private_data
, int offset
)
1920 event
->param
.conn
.private_data
= private_data
+ offset
;
1921 event
->param
.conn
.private_data_len
= IB_CM_REQ_PRIVATE_DATA_SIZE
- offset
;
1922 event
->param
.conn
.responder_resources
= req_data
->responder_resources
;
1923 event
->param
.conn
.initiator_depth
= req_data
->initiator_depth
;
1924 event
->param
.conn
.flow_control
= req_data
->flow_control
;
1925 event
->param
.conn
.retry_count
= req_data
->retry_count
;
1926 event
->param
.conn
.rnr_retry_count
= req_data
->rnr_retry_count
;
1927 event
->param
.conn
.srq
= req_data
->srq
;
1928 event
->param
.conn
.qp_num
= req_data
->remote_qpn
;
1931 static int cma_check_req_qp_type(struct rdma_cm_id
*id
, struct ib_cm_event
*ib_event
)
1933 return (((ib_event
->event
== IB_CM_REQ_RECEIVED
) &&
1934 (ib_event
->param
.req_rcvd
.qp_type
== id
->qp_type
)) ||
1935 ((ib_event
->event
== IB_CM_SIDR_REQ_RECEIVED
) &&
1936 (id
->qp_type
== IB_QPT_UD
)) ||
1940 static int cma_req_handler(struct ib_cm_id
*cm_id
, struct ib_cm_event
*ib_event
)
1942 struct rdma_id_private
*listen_id
, *conn_id
= NULL
;
1943 struct rdma_cm_event event
;
1944 struct net_device
*net_dev
;
1947 listen_id
= cma_id_from_event(cm_id
, ib_event
, &net_dev
);
1948 if (IS_ERR(listen_id
))
1949 return PTR_ERR(listen_id
);
1951 if (!cma_check_req_qp_type(&listen_id
->id
, ib_event
)) {
1956 mutex_lock(&listen_id
->handler_mutex
);
1957 if (listen_id
->state
!= RDMA_CM_LISTEN
) {
1958 ret
= -ECONNABORTED
;
1962 memset(&event
, 0, sizeof event
);
1963 offset
= cma_user_data_offset(listen_id
);
1964 event
.event
= RDMA_CM_EVENT_CONNECT_REQUEST
;
1965 if (ib_event
->event
== IB_CM_SIDR_REQ_RECEIVED
) {
1966 conn_id
= cma_new_udp_id(&listen_id
->id
, ib_event
, net_dev
);
1967 event
.param
.ud
.private_data
= ib_event
->private_data
+ offset
;
1968 event
.param
.ud
.private_data_len
=
1969 IB_CM_SIDR_REQ_PRIVATE_DATA_SIZE
- offset
;
1971 conn_id
= cma_new_conn_id(&listen_id
->id
, ib_event
, net_dev
);
1972 cma_set_req_event_data(&event
, &ib_event
->param
.req_rcvd
,
1973 ib_event
->private_data
, offset
);
1980 mutex_lock_nested(&conn_id
->handler_mutex
, SINGLE_DEPTH_NESTING
);
1981 ret
= cma_acquire_dev(conn_id
, listen_id
);
1985 conn_id
->cm_id
.ib
= cm_id
;
1986 cm_id
->context
= conn_id
;
1987 cm_id
->cm_handler
= cma_ib_handler
;
1990 * Protect against the user destroying conn_id from another thread
1991 * until we're done accessing it.
1993 atomic_inc(&conn_id
->refcount
);
1994 ret
= conn_id
->id
.event_handler(&conn_id
->id
, &event
);
1998 * Acquire mutex to prevent user executing rdma_destroy_id()
1999 * while we're accessing the cm_id.
2002 if (cma_comp(conn_id
, RDMA_CM_CONNECT
) &&
2003 (conn_id
->id
.qp_type
!= IB_QPT_UD
))
2004 ib_send_cm_mra(cm_id
, CMA_CM_MRA_SETTING
, NULL
, 0);
2005 mutex_unlock(&lock
);
2006 mutex_unlock(&conn_id
->handler_mutex
);
2007 mutex_unlock(&listen_id
->handler_mutex
);
2008 cma_deref_id(conn_id
);
2014 cma_deref_id(conn_id
);
2015 /* Destroy the CM ID by returning a non-zero value. */
2016 conn_id
->cm_id
.ib
= NULL
;
2018 cma_exch(conn_id
, RDMA_CM_DESTROYING
);
2019 mutex_unlock(&conn_id
->handler_mutex
);
2021 mutex_unlock(&listen_id
->handler_mutex
);
2023 rdma_destroy_id(&conn_id
->id
);
2032 __be64
rdma_get_service_id(struct rdma_cm_id
*id
, struct sockaddr
*addr
)
2034 if (addr
->sa_family
== AF_IB
)
2035 return ((struct sockaddr_ib
*) addr
)->sib_sid
;
2037 return cpu_to_be64(((u64
)id
->ps
<< 16) + be16_to_cpu(cma_port(addr
)));
2039 EXPORT_SYMBOL(rdma_get_service_id
);
2041 static int cma_iw_handler(struct iw_cm_id
*iw_id
, struct iw_cm_event
*iw_event
)
2043 struct rdma_id_private
*id_priv
= iw_id
->context
;
2044 struct rdma_cm_event event
;
2046 struct sockaddr
*laddr
= (struct sockaddr
*)&iw_event
->local_addr
;
2047 struct sockaddr
*raddr
= (struct sockaddr
*)&iw_event
->remote_addr
;
2049 mutex_lock(&id_priv
->handler_mutex
);
2050 if (id_priv
->state
!= RDMA_CM_CONNECT
)
2053 memset(&event
, 0, sizeof event
);
2054 switch (iw_event
->event
) {
2055 case IW_CM_EVENT_CLOSE
:
2056 event
.event
= RDMA_CM_EVENT_DISCONNECTED
;
2058 case IW_CM_EVENT_CONNECT_REPLY
:
2059 memcpy(cma_src_addr(id_priv
), laddr
,
2060 rdma_addr_size(laddr
));
2061 memcpy(cma_dst_addr(id_priv
), raddr
,
2062 rdma_addr_size(raddr
));
2063 switch (iw_event
->status
) {
2065 event
.event
= RDMA_CM_EVENT_ESTABLISHED
;
2066 event
.param
.conn
.initiator_depth
= iw_event
->ird
;
2067 event
.param
.conn
.responder_resources
= iw_event
->ord
;
2071 event
.event
= RDMA_CM_EVENT_REJECTED
;
2074 event
.event
= RDMA_CM_EVENT_UNREACHABLE
;
2077 event
.event
= RDMA_CM_EVENT_CONNECT_ERROR
;
2081 case IW_CM_EVENT_ESTABLISHED
:
2082 event
.event
= RDMA_CM_EVENT_ESTABLISHED
;
2083 event
.param
.conn
.initiator_depth
= iw_event
->ird
;
2084 event
.param
.conn
.responder_resources
= iw_event
->ord
;
2090 event
.status
= iw_event
->status
;
2091 event
.param
.conn
.private_data
= iw_event
->private_data
;
2092 event
.param
.conn
.private_data_len
= iw_event
->private_data_len
;
2093 ret
= id_priv
->id
.event_handler(&id_priv
->id
, &event
);
2095 /* Destroy the CM ID by returning a non-zero value. */
2096 id_priv
->cm_id
.iw
= NULL
;
2097 cma_exch(id_priv
, RDMA_CM_DESTROYING
);
2098 mutex_unlock(&id_priv
->handler_mutex
);
2099 rdma_destroy_id(&id_priv
->id
);
2104 mutex_unlock(&id_priv
->handler_mutex
);
2108 static int iw_conn_req_handler(struct iw_cm_id
*cm_id
,
2109 struct iw_cm_event
*iw_event
)
2111 struct rdma_cm_id
*new_cm_id
;
2112 struct rdma_id_private
*listen_id
, *conn_id
;
2113 struct rdma_cm_event event
;
2114 int ret
= -ECONNABORTED
;
2115 struct sockaddr
*laddr
= (struct sockaddr
*)&iw_event
->local_addr
;
2116 struct sockaddr
*raddr
= (struct sockaddr
*)&iw_event
->remote_addr
;
2118 listen_id
= cm_id
->context
;
2120 mutex_lock(&listen_id
->handler_mutex
);
2121 if (listen_id
->state
!= RDMA_CM_LISTEN
)
2124 /* Create a new RDMA id for the new IW CM ID */
2125 new_cm_id
= rdma_create_id(listen_id
->id
.route
.addr
.dev_addr
.net
,
2126 listen_id
->id
.event_handler
,
2127 listen_id
->id
.context
,
2128 RDMA_PS_TCP
, IB_QPT_RC
);
2129 if (IS_ERR(new_cm_id
)) {
2133 conn_id
= container_of(new_cm_id
, struct rdma_id_private
, id
);
2134 mutex_lock_nested(&conn_id
->handler_mutex
, SINGLE_DEPTH_NESTING
);
2135 conn_id
->state
= RDMA_CM_CONNECT
;
2137 ret
= rdma_translate_ip(laddr
, &conn_id
->id
.route
.addr
.dev_addr
, NULL
);
2139 mutex_unlock(&conn_id
->handler_mutex
);
2140 rdma_destroy_id(new_cm_id
);
2144 ret
= cma_acquire_dev(conn_id
, listen_id
);
2146 mutex_unlock(&conn_id
->handler_mutex
);
2147 rdma_destroy_id(new_cm_id
);
2151 conn_id
->cm_id
.iw
= cm_id
;
2152 cm_id
->context
= conn_id
;
2153 cm_id
->cm_handler
= cma_iw_handler
;
2155 memcpy(cma_src_addr(conn_id
), laddr
, rdma_addr_size(laddr
));
2156 memcpy(cma_dst_addr(conn_id
), raddr
, rdma_addr_size(raddr
));
2158 memset(&event
, 0, sizeof event
);
2159 event
.event
= RDMA_CM_EVENT_CONNECT_REQUEST
;
2160 event
.param
.conn
.private_data
= iw_event
->private_data
;
2161 event
.param
.conn
.private_data_len
= iw_event
->private_data_len
;
2162 event
.param
.conn
.initiator_depth
= iw_event
->ird
;
2163 event
.param
.conn
.responder_resources
= iw_event
->ord
;
2166 * Protect against the user destroying conn_id from another thread
2167 * until we're done accessing it.
2169 atomic_inc(&conn_id
->refcount
);
2170 ret
= conn_id
->id
.event_handler(&conn_id
->id
, &event
);
2172 /* User wants to destroy the CM ID */
2173 conn_id
->cm_id
.iw
= NULL
;
2174 cma_exch(conn_id
, RDMA_CM_DESTROYING
);
2175 mutex_unlock(&conn_id
->handler_mutex
);
2176 cma_deref_id(conn_id
);
2177 rdma_destroy_id(&conn_id
->id
);
2181 mutex_unlock(&conn_id
->handler_mutex
);
2182 cma_deref_id(conn_id
);
2185 mutex_unlock(&listen_id
->handler_mutex
);
2189 static int cma_ib_listen(struct rdma_id_private
*id_priv
)
2191 struct sockaddr
*addr
;
2192 struct ib_cm_id
*id
;
2195 addr
= cma_src_addr(id_priv
);
2196 svc_id
= rdma_get_service_id(&id_priv
->id
, addr
);
2197 id
= ib_cm_insert_listen(id_priv
->id
.device
, cma_req_handler
, svc_id
);
2200 id_priv
->cm_id
.ib
= id
;
2205 static int cma_iw_listen(struct rdma_id_private
*id_priv
, int backlog
)
2208 struct iw_cm_id
*id
;
2210 id
= iw_create_cm_id(id_priv
->id
.device
,
2211 iw_conn_req_handler
,
2216 id
->tos
= id_priv
->tos
;
2217 id_priv
->cm_id
.iw
= id
;
2219 memcpy(&id_priv
->cm_id
.iw
->local_addr
, cma_src_addr(id_priv
),
2220 rdma_addr_size(cma_src_addr(id_priv
)));
2222 ret
= iw_cm_listen(id_priv
->cm_id
.iw
, backlog
);
2225 iw_destroy_cm_id(id_priv
->cm_id
.iw
);
2226 id_priv
->cm_id
.iw
= NULL
;
2232 static int cma_listen_handler(struct rdma_cm_id
*id
,
2233 struct rdma_cm_event
*event
)
2235 struct rdma_id_private
*id_priv
= id
->context
;
2237 id
->context
= id_priv
->id
.context
;
2238 id
->event_handler
= id_priv
->id
.event_handler
;
2239 return id_priv
->id
.event_handler(id
, event
);
2242 static void cma_listen_on_dev(struct rdma_id_private
*id_priv
,
2243 struct cma_device
*cma_dev
)
2245 struct rdma_id_private
*dev_id_priv
;
2246 struct rdma_cm_id
*id
;
2247 struct net
*net
= id_priv
->id
.route
.addr
.dev_addr
.net
;
2250 if (cma_family(id_priv
) == AF_IB
&& !rdma_cap_ib_cm(cma_dev
->device
, 1))
2253 id
= rdma_create_id(net
, cma_listen_handler
, id_priv
, id_priv
->id
.ps
,
2254 id_priv
->id
.qp_type
);
2258 dev_id_priv
= container_of(id
, struct rdma_id_private
, id
);
2260 dev_id_priv
->state
= RDMA_CM_ADDR_BOUND
;
2261 memcpy(cma_src_addr(dev_id_priv
), cma_src_addr(id_priv
),
2262 rdma_addr_size(cma_src_addr(id_priv
)));
2264 _cma_attach_to_dev(dev_id_priv
, cma_dev
);
2265 list_add_tail(&dev_id_priv
->listen_list
, &id_priv
->listen_list
);
2266 atomic_inc(&id_priv
->refcount
);
2267 dev_id_priv
->internal_id
= 1;
2268 dev_id_priv
->afonly
= id_priv
->afonly
;
2270 ret
= rdma_listen(id
, id_priv
->backlog
);
2272 pr_warn("RDMA CMA: cma_listen_on_dev, error %d, listening on device %s\n",
2273 ret
, cma_dev
->device
->name
);
2276 static void cma_listen_on_all(struct rdma_id_private
*id_priv
)
2278 struct cma_device
*cma_dev
;
2281 list_add_tail(&id_priv
->list
, &listen_any_list
);
2282 list_for_each_entry(cma_dev
, &dev_list
, list
)
2283 cma_listen_on_dev(id_priv
, cma_dev
);
2284 mutex_unlock(&lock
);
2287 void rdma_set_service_type(struct rdma_cm_id
*id
, int tos
)
2289 struct rdma_id_private
*id_priv
;
2291 id_priv
= container_of(id
, struct rdma_id_private
, id
);
2292 id_priv
->tos
= (u8
) tos
;
2293 id_priv
->tos_set
= true;
2295 EXPORT_SYMBOL(rdma_set_service_type
);
2297 static void cma_query_handler(int status
, struct sa_path_rec
*path_rec
,
2300 struct cma_work
*work
= context
;
2301 struct rdma_route
*route
;
2303 route
= &work
->id
->id
.route
;
2306 route
->num_paths
= 1;
2307 *route
->path_rec
= *path_rec
;
2309 work
->old_state
= RDMA_CM_ROUTE_QUERY
;
2310 work
->new_state
= RDMA_CM_ADDR_RESOLVED
;
2311 work
->event
.event
= RDMA_CM_EVENT_ROUTE_ERROR
;
2312 work
->event
.status
= status
;
2313 pr_debug_ratelimited("RDMA CM: ROUTE_ERROR: failed to query path. status %d\n",
2317 queue_work(cma_wq
, &work
->work
);
2320 static int cma_query_ib_route(struct rdma_id_private
*id_priv
, int timeout_ms
,
2321 struct cma_work
*work
)
2323 struct rdma_dev_addr
*dev_addr
= &id_priv
->id
.route
.addr
.dev_addr
;
2324 struct sa_path_rec path_rec
;
2325 ib_sa_comp_mask comp_mask
;
2326 struct sockaddr_in6
*sin6
;
2327 struct sockaddr_ib
*sib
;
2329 memset(&path_rec
, 0, sizeof path_rec
);
2331 if (rdma_cap_opa_ah(id_priv
->id
.device
, id_priv
->id
.port_num
))
2332 path_rec
.rec_type
= SA_PATH_REC_TYPE_OPA
;
2334 path_rec
.rec_type
= SA_PATH_REC_TYPE_IB
;
2335 rdma_addr_get_sgid(dev_addr
, &path_rec
.sgid
);
2336 rdma_addr_get_dgid(dev_addr
, &path_rec
.dgid
);
2337 path_rec
.pkey
= cpu_to_be16(ib_addr_get_pkey(dev_addr
));
2338 path_rec
.numb_path
= 1;
2339 path_rec
.reversible
= 1;
2340 path_rec
.service_id
= rdma_get_service_id(&id_priv
->id
,
2341 cma_dst_addr(id_priv
));
2343 comp_mask
= IB_SA_PATH_REC_DGID
| IB_SA_PATH_REC_SGID
|
2344 IB_SA_PATH_REC_PKEY
| IB_SA_PATH_REC_NUMB_PATH
|
2345 IB_SA_PATH_REC_REVERSIBLE
| IB_SA_PATH_REC_SERVICE_ID
;
2347 switch (cma_family(id_priv
)) {
2349 path_rec
.qos_class
= cpu_to_be16((u16
) id_priv
->tos
);
2350 comp_mask
|= IB_SA_PATH_REC_QOS_CLASS
;
2353 sin6
= (struct sockaddr_in6
*) cma_src_addr(id_priv
);
2354 path_rec
.traffic_class
= (u8
) (be32_to_cpu(sin6
->sin6_flowinfo
) >> 20);
2355 comp_mask
|= IB_SA_PATH_REC_TRAFFIC_CLASS
;
2358 sib
= (struct sockaddr_ib
*) cma_src_addr(id_priv
);
2359 path_rec
.traffic_class
= (u8
) (be32_to_cpu(sib
->sib_flowinfo
) >> 20);
2360 comp_mask
|= IB_SA_PATH_REC_TRAFFIC_CLASS
;
2364 id_priv
->query_id
= ib_sa_path_rec_get(&sa_client
, id_priv
->id
.device
,
2365 id_priv
->id
.port_num
, &path_rec
,
2366 comp_mask
, timeout_ms
,
2367 GFP_KERNEL
, cma_query_handler
,
2368 work
, &id_priv
->query
);
2370 return (id_priv
->query_id
< 0) ? id_priv
->query_id
: 0;
2373 static void cma_work_handler(struct work_struct
*_work
)
2375 struct cma_work
*work
= container_of(_work
, struct cma_work
, work
);
2376 struct rdma_id_private
*id_priv
= work
->id
;
2379 mutex_lock(&id_priv
->handler_mutex
);
2380 if (!cma_comp_exch(id_priv
, work
->old_state
, work
->new_state
))
2383 if (id_priv
->id
.event_handler(&id_priv
->id
, &work
->event
)) {
2384 cma_exch(id_priv
, RDMA_CM_DESTROYING
);
2388 mutex_unlock(&id_priv
->handler_mutex
);
2389 cma_deref_id(id_priv
);
2391 rdma_destroy_id(&id_priv
->id
);
2395 static void cma_ndev_work_handler(struct work_struct
*_work
)
2397 struct cma_ndev_work
*work
= container_of(_work
, struct cma_ndev_work
, work
);
2398 struct rdma_id_private
*id_priv
= work
->id
;
2401 mutex_lock(&id_priv
->handler_mutex
);
2402 if (id_priv
->state
== RDMA_CM_DESTROYING
||
2403 id_priv
->state
== RDMA_CM_DEVICE_REMOVAL
)
2406 if (id_priv
->id
.event_handler(&id_priv
->id
, &work
->event
)) {
2407 cma_exch(id_priv
, RDMA_CM_DESTROYING
);
2412 mutex_unlock(&id_priv
->handler_mutex
);
2413 cma_deref_id(id_priv
);
2415 rdma_destroy_id(&id_priv
->id
);
2419 static int cma_resolve_ib_route(struct rdma_id_private
*id_priv
, int timeout_ms
)
2421 struct rdma_route
*route
= &id_priv
->id
.route
;
2422 struct cma_work
*work
;
2425 work
= kzalloc(sizeof *work
, GFP_KERNEL
);
2430 INIT_WORK(&work
->work
, cma_work_handler
);
2431 work
->old_state
= RDMA_CM_ROUTE_QUERY
;
2432 work
->new_state
= RDMA_CM_ROUTE_RESOLVED
;
2433 work
->event
.event
= RDMA_CM_EVENT_ROUTE_RESOLVED
;
2435 route
->path_rec
= kmalloc(sizeof *route
->path_rec
, GFP_KERNEL
);
2436 if (!route
->path_rec
) {
2441 ret
= cma_query_ib_route(id_priv
, timeout_ms
, work
);
2447 kfree(route
->path_rec
);
2448 route
->path_rec
= NULL
;
2454 int rdma_set_ib_paths(struct rdma_cm_id
*id
,
2455 struct sa_path_rec
*path_rec
, int num_paths
)
2457 struct rdma_id_private
*id_priv
;
2460 id_priv
= container_of(id
, struct rdma_id_private
, id
);
2461 if (!cma_comp_exch(id_priv
, RDMA_CM_ADDR_RESOLVED
,
2462 RDMA_CM_ROUTE_RESOLVED
))
2465 id
->route
.path_rec
= kmemdup(path_rec
, sizeof *path_rec
* num_paths
,
2467 if (!id
->route
.path_rec
) {
2472 id
->route
.num_paths
= num_paths
;
2475 cma_comp_exch(id_priv
, RDMA_CM_ROUTE_RESOLVED
, RDMA_CM_ADDR_RESOLVED
);
2478 EXPORT_SYMBOL(rdma_set_ib_paths
);
2480 static int cma_resolve_iw_route(struct rdma_id_private
*id_priv
, int timeout_ms
)
2482 struct cma_work
*work
;
2484 work
= kzalloc(sizeof *work
, GFP_KERNEL
);
2489 INIT_WORK(&work
->work
, cma_work_handler
);
2490 work
->old_state
= RDMA_CM_ROUTE_QUERY
;
2491 work
->new_state
= RDMA_CM_ROUTE_RESOLVED
;
2492 work
->event
.event
= RDMA_CM_EVENT_ROUTE_RESOLVED
;
2493 queue_work(cma_wq
, &work
->work
);
2497 static int iboe_tos_to_sl(struct net_device
*ndev
, int tos
)
2500 struct net_device
*dev
;
2502 prio
= rt_tos2priority(tos
);
2503 dev
= is_vlan_dev(ndev
) ? vlan_dev_real_dev(ndev
) : ndev
;
2505 return netdev_get_prio_tc_map(dev
, prio
);
2507 #if IS_ENABLED(CONFIG_VLAN_8021Q)
2508 if (is_vlan_dev(ndev
))
2509 return (vlan_dev_get_egress_qos_mask(ndev
, prio
) &
2510 VLAN_PRIO_MASK
) >> VLAN_PRIO_SHIFT
;
2515 static enum ib_gid_type
cma_route_gid_type(enum rdma_network_type network_type
,
2516 unsigned long supported_gids
,
2517 enum ib_gid_type default_gid
)
2519 if ((network_type
== RDMA_NETWORK_IPV4
||
2520 network_type
== RDMA_NETWORK_IPV6
) &&
2521 test_bit(IB_GID_TYPE_ROCE_UDP_ENCAP
, &supported_gids
))
2522 return IB_GID_TYPE_ROCE_UDP_ENCAP
;
2527 static int cma_resolve_iboe_route(struct rdma_id_private
*id_priv
)
2529 struct rdma_route
*route
= &id_priv
->id
.route
;
2530 struct rdma_addr
*addr
= &route
->addr
;
2531 struct cma_work
*work
;
2533 struct net_device
*ndev
= NULL
;
2534 enum ib_gid_type gid_type
= IB_GID_TYPE_IB
;
2535 u8 default_roce_tos
= id_priv
->cma_dev
->default_roce_tos
[id_priv
->id
.port_num
-
2536 rdma_start_port(id_priv
->cma_dev
->device
)];
2537 u8 tos
= id_priv
->tos_set
? id_priv
->tos
: default_roce_tos
;
2540 work
= kzalloc(sizeof *work
, GFP_KERNEL
);
2545 INIT_WORK(&work
->work
, cma_work_handler
);
2547 route
->path_rec
= kzalloc(sizeof *route
->path_rec
, GFP_KERNEL
);
2548 if (!route
->path_rec
) {
2553 route
->num_paths
= 1;
2555 if (addr
->dev_addr
.bound_dev_if
) {
2556 unsigned long supported_gids
;
2558 ndev
= dev_get_by_index(&init_net
, addr
->dev_addr
.bound_dev_if
);
2564 supported_gids
= roce_gid_type_mask_support(id_priv
->id
.device
,
2565 id_priv
->id
.port_num
);
2566 gid_type
= cma_route_gid_type(addr
->dev_addr
.network
,
2569 route
->path_rec
->rec_type
=
2570 sa_conv_gid_to_pathrec_type(gid_type
);
2571 sa_path_set_ndev(route
->path_rec
, &init_net
);
2572 sa_path_set_ifindex(route
->path_rec
, ndev
->ifindex
);
2579 sa_path_set_dmac(route
->path_rec
, addr
->dev_addr
.dst_dev_addr
);
2581 rdma_ip2gid((struct sockaddr
*)&id_priv
->id
.route
.addr
.src_addr
,
2582 &route
->path_rec
->sgid
);
2583 rdma_ip2gid((struct sockaddr
*)&id_priv
->id
.route
.addr
.dst_addr
,
2584 &route
->path_rec
->dgid
);
2586 /* Use the hint from IP Stack to select GID Type */
2587 if (gid_type
< ib_network_to_gid_type(addr
->dev_addr
.network
))
2588 gid_type
= ib_network_to_gid_type(addr
->dev_addr
.network
);
2589 route
->path_rec
->rec_type
= sa_conv_gid_to_pathrec_type(gid_type
);
2591 if (((struct sockaddr
*)&id_priv
->id
.route
.addr
.dst_addr
)->sa_family
!= AF_IB
)
2592 /* TODO: get the hoplimit from the inet/inet6 device */
2593 route
->path_rec
->hop_limit
= addr
->dev_addr
.hoplimit
;
2595 route
->path_rec
->hop_limit
= 1;
2596 route
->path_rec
->reversible
= 1;
2597 route
->path_rec
->pkey
= cpu_to_be16(0xffff);
2598 route
->path_rec
->mtu_selector
= IB_SA_EQ
;
2599 route
->path_rec
->sl
= iboe_tos_to_sl(ndev
, tos
);
2600 route
->path_rec
->traffic_class
= tos
;
2601 route
->path_rec
->mtu
= iboe_get_mtu(ndev
->mtu
);
2602 route
->path_rec
->rate_selector
= IB_SA_EQ
;
2603 route
->path_rec
->rate
= iboe_get_rate(ndev
);
2605 route
->path_rec
->packet_life_time_selector
= IB_SA_EQ
;
2606 route
->path_rec
->packet_life_time
= CMA_IBOE_PACKET_LIFETIME
;
2607 if (!route
->path_rec
->mtu
) {
2612 work
->old_state
= RDMA_CM_ROUTE_QUERY
;
2613 work
->new_state
= RDMA_CM_ROUTE_RESOLVED
;
2614 work
->event
.event
= RDMA_CM_EVENT_ROUTE_RESOLVED
;
2615 work
->event
.status
= 0;
2617 queue_work(cma_wq
, &work
->work
);
2622 kfree(route
->path_rec
);
2623 route
->path_rec
= NULL
;
2629 int rdma_resolve_route(struct rdma_cm_id
*id
, int timeout_ms
)
2631 struct rdma_id_private
*id_priv
;
2634 id_priv
= container_of(id
, struct rdma_id_private
, id
);
2635 if (!cma_comp_exch(id_priv
, RDMA_CM_ADDR_RESOLVED
, RDMA_CM_ROUTE_QUERY
))
2638 atomic_inc(&id_priv
->refcount
);
2639 if (rdma_cap_ib_sa(id
->device
, id
->port_num
))
2640 ret
= cma_resolve_ib_route(id_priv
, timeout_ms
);
2641 else if (rdma_protocol_roce(id
->device
, id
->port_num
))
2642 ret
= cma_resolve_iboe_route(id_priv
);
2643 else if (rdma_protocol_iwarp(id
->device
, id
->port_num
))
2644 ret
= cma_resolve_iw_route(id_priv
, timeout_ms
);
2653 cma_comp_exch(id_priv
, RDMA_CM_ROUTE_QUERY
, RDMA_CM_ADDR_RESOLVED
);
2654 cma_deref_id(id_priv
);
2657 EXPORT_SYMBOL(rdma_resolve_route
);
2659 static void cma_set_loopback(struct sockaddr
*addr
)
2661 switch (addr
->sa_family
) {
2663 ((struct sockaddr_in
*) addr
)->sin_addr
.s_addr
= htonl(INADDR_LOOPBACK
);
2666 ipv6_addr_set(&((struct sockaddr_in6
*) addr
)->sin6_addr
,
2670 ib_addr_set(&((struct sockaddr_ib
*) addr
)->sib_addr
,
2676 static int cma_bind_loopback(struct rdma_id_private
*id_priv
)
2678 struct cma_device
*cma_dev
, *cur_dev
;
2680 enum ib_port_state port_state
;
2687 list_for_each_entry(cur_dev
, &dev_list
, list
) {
2688 if (cma_family(id_priv
) == AF_IB
&&
2689 !rdma_cap_ib_cm(cur_dev
->device
, 1))
2695 for (p
= 1; p
<= cur_dev
->device
->phys_port_cnt
; ++p
) {
2696 if (!ib_get_cached_port_state(cur_dev
->device
, p
, &port_state
) &&
2697 port_state
== IB_PORT_ACTIVE
) {
2712 ret
= ib_get_cached_gid(cma_dev
->device
, p
, 0, &gid
, NULL
);
2716 ret
= ib_get_cached_pkey(cma_dev
->device
, p
, 0, &pkey
);
2720 id_priv
->id
.route
.addr
.dev_addr
.dev_type
=
2721 (rdma_protocol_ib(cma_dev
->device
, p
)) ?
2722 ARPHRD_INFINIBAND
: ARPHRD_ETHER
;
2724 rdma_addr_set_sgid(&id_priv
->id
.route
.addr
.dev_addr
, &gid
);
2725 ib_addr_set_pkey(&id_priv
->id
.route
.addr
.dev_addr
, pkey
);
2726 id_priv
->id
.port_num
= p
;
2727 cma_attach_to_dev(id_priv
, cma_dev
);
2728 cma_set_loopback(cma_src_addr(id_priv
));
2730 mutex_unlock(&lock
);
2734 static void addr_handler(int status
, struct sockaddr
*src_addr
,
2735 struct rdma_dev_addr
*dev_addr
, void *context
)
2737 struct rdma_id_private
*id_priv
= context
;
2738 struct rdma_cm_event event
;
2740 memset(&event
, 0, sizeof event
);
2741 mutex_lock(&id_priv
->handler_mutex
);
2742 if (!cma_comp_exch(id_priv
, RDMA_CM_ADDR_QUERY
,
2743 RDMA_CM_ADDR_RESOLVED
))
2746 memcpy(cma_src_addr(id_priv
), src_addr
, rdma_addr_size(src_addr
));
2747 if (!status
&& !id_priv
->cma_dev
) {
2748 status
= cma_acquire_dev(id_priv
, NULL
);
2750 pr_debug_ratelimited("RDMA CM: ADDR_ERROR: failed to acquire device. status %d\n",
2753 pr_debug_ratelimited("RDMA CM: ADDR_ERROR: failed to resolve IP. status %d\n", status
);
2757 if (!cma_comp_exch(id_priv
, RDMA_CM_ADDR_RESOLVED
,
2758 RDMA_CM_ADDR_BOUND
))
2760 event
.event
= RDMA_CM_EVENT_ADDR_ERROR
;
2761 event
.status
= status
;
2763 event
.event
= RDMA_CM_EVENT_ADDR_RESOLVED
;
2765 if (id_priv
->id
.event_handler(&id_priv
->id
, &event
)) {
2766 cma_exch(id_priv
, RDMA_CM_DESTROYING
);
2767 mutex_unlock(&id_priv
->handler_mutex
);
2768 cma_deref_id(id_priv
);
2769 rdma_destroy_id(&id_priv
->id
);
2773 mutex_unlock(&id_priv
->handler_mutex
);
2774 cma_deref_id(id_priv
);
2777 static int cma_resolve_loopback(struct rdma_id_private
*id_priv
)
2779 struct cma_work
*work
;
2783 work
= kzalloc(sizeof *work
, GFP_KERNEL
);
2787 if (!id_priv
->cma_dev
) {
2788 ret
= cma_bind_loopback(id_priv
);
2793 rdma_addr_get_sgid(&id_priv
->id
.route
.addr
.dev_addr
, &gid
);
2794 rdma_addr_set_dgid(&id_priv
->id
.route
.addr
.dev_addr
, &gid
);
2797 INIT_WORK(&work
->work
, cma_work_handler
);
2798 work
->old_state
= RDMA_CM_ADDR_QUERY
;
2799 work
->new_state
= RDMA_CM_ADDR_RESOLVED
;
2800 work
->event
.event
= RDMA_CM_EVENT_ADDR_RESOLVED
;
2801 queue_work(cma_wq
, &work
->work
);
2808 static int cma_resolve_ib_addr(struct rdma_id_private
*id_priv
)
2810 struct cma_work
*work
;
2813 work
= kzalloc(sizeof *work
, GFP_KERNEL
);
2817 if (!id_priv
->cma_dev
) {
2818 ret
= cma_resolve_ib_dev(id_priv
);
2823 rdma_addr_set_dgid(&id_priv
->id
.route
.addr
.dev_addr
, (union ib_gid
*)
2824 &(((struct sockaddr_ib
*) &id_priv
->id
.route
.addr
.dst_addr
)->sib_addr
));
2827 INIT_WORK(&work
->work
, cma_work_handler
);
2828 work
->old_state
= RDMA_CM_ADDR_QUERY
;
2829 work
->new_state
= RDMA_CM_ADDR_RESOLVED
;
2830 work
->event
.event
= RDMA_CM_EVENT_ADDR_RESOLVED
;
2831 queue_work(cma_wq
, &work
->work
);
2838 static int cma_bind_addr(struct rdma_cm_id
*id
, struct sockaddr
*src_addr
,
2839 struct sockaddr
*dst_addr
)
2841 if (!src_addr
|| !src_addr
->sa_family
) {
2842 src_addr
= (struct sockaddr
*) &id
->route
.addr
.src_addr
;
2843 src_addr
->sa_family
= dst_addr
->sa_family
;
2844 if (IS_ENABLED(CONFIG_IPV6
) &&
2845 dst_addr
->sa_family
== AF_INET6
) {
2846 struct sockaddr_in6
*src_addr6
= (struct sockaddr_in6
*) src_addr
;
2847 struct sockaddr_in6
*dst_addr6
= (struct sockaddr_in6
*) dst_addr
;
2848 src_addr6
->sin6_scope_id
= dst_addr6
->sin6_scope_id
;
2849 if (ipv6_addr_type(&dst_addr6
->sin6_addr
) & IPV6_ADDR_LINKLOCAL
)
2850 id
->route
.addr
.dev_addr
.bound_dev_if
= dst_addr6
->sin6_scope_id
;
2851 } else if (dst_addr
->sa_family
== AF_IB
) {
2852 ((struct sockaddr_ib
*) src_addr
)->sib_pkey
=
2853 ((struct sockaddr_ib
*) dst_addr
)->sib_pkey
;
2856 return rdma_bind_addr(id
, src_addr
);
2859 int rdma_resolve_addr(struct rdma_cm_id
*id
, struct sockaddr
*src_addr
,
2860 struct sockaddr
*dst_addr
, int timeout_ms
)
2862 struct rdma_id_private
*id_priv
;
2865 id_priv
= container_of(id
, struct rdma_id_private
, id
);
2866 memcpy(cma_dst_addr(id_priv
), dst_addr
, rdma_addr_size(dst_addr
));
2867 if (id_priv
->state
== RDMA_CM_IDLE
) {
2868 ret
= cma_bind_addr(id
, src_addr
, dst_addr
);
2870 memset(cma_dst_addr(id_priv
), 0, rdma_addr_size(dst_addr
));
2875 if (cma_family(id_priv
) != dst_addr
->sa_family
) {
2876 memset(cma_dst_addr(id_priv
), 0, rdma_addr_size(dst_addr
));
2880 if (!cma_comp_exch(id_priv
, RDMA_CM_ADDR_BOUND
, RDMA_CM_ADDR_QUERY
)) {
2881 memset(cma_dst_addr(id_priv
), 0, rdma_addr_size(dst_addr
));
2885 atomic_inc(&id_priv
->refcount
);
2886 if (cma_any_addr(dst_addr
)) {
2887 ret
= cma_resolve_loopback(id_priv
);
2889 if (dst_addr
->sa_family
== AF_IB
) {
2890 ret
= cma_resolve_ib_addr(id_priv
);
2892 ret
= rdma_resolve_ip(&addr_client
, cma_src_addr(id_priv
),
2893 dst_addr
, &id
->route
.addr
.dev_addr
,
2894 timeout_ms
, addr_handler
, id_priv
);
2902 cma_comp_exch(id_priv
, RDMA_CM_ADDR_QUERY
, RDMA_CM_ADDR_BOUND
);
2903 cma_deref_id(id_priv
);
2906 EXPORT_SYMBOL(rdma_resolve_addr
);
2908 int rdma_set_reuseaddr(struct rdma_cm_id
*id
, int reuse
)
2910 struct rdma_id_private
*id_priv
;
2911 unsigned long flags
;
2914 id_priv
= container_of(id
, struct rdma_id_private
, id
);
2915 spin_lock_irqsave(&id_priv
->lock
, flags
);
2916 if (reuse
|| id_priv
->state
== RDMA_CM_IDLE
) {
2917 id_priv
->reuseaddr
= reuse
;
2922 spin_unlock_irqrestore(&id_priv
->lock
, flags
);
2925 EXPORT_SYMBOL(rdma_set_reuseaddr
);
2927 int rdma_set_afonly(struct rdma_cm_id
*id
, int afonly
)
2929 struct rdma_id_private
*id_priv
;
2930 unsigned long flags
;
2933 id_priv
= container_of(id
, struct rdma_id_private
, id
);
2934 spin_lock_irqsave(&id_priv
->lock
, flags
);
2935 if (id_priv
->state
== RDMA_CM_IDLE
|| id_priv
->state
== RDMA_CM_ADDR_BOUND
) {
2936 id_priv
->options
|= (1 << CMA_OPTION_AFONLY
);
2937 id_priv
->afonly
= afonly
;
2942 spin_unlock_irqrestore(&id_priv
->lock
, flags
);
2945 EXPORT_SYMBOL(rdma_set_afonly
);
2947 static void cma_bind_port(struct rdma_bind_list
*bind_list
,
2948 struct rdma_id_private
*id_priv
)
2950 struct sockaddr
*addr
;
2951 struct sockaddr_ib
*sib
;
2955 addr
= cma_src_addr(id_priv
);
2956 port
= htons(bind_list
->port
);
2958 switch (addr
->sa_family
) {
2960 ((struct sockaddr_in
*) addr
)->sin_port
= port
;
2963 ((struct sockaddr_in6
*) addr
)->sin6_port
= port
;
2966 sib
= (struct sockaddr_ib
*) addr
;
2967 sid
= be64_to_cpu(sib
->sib_sid
);
2968 mask
= be64_to_cpu(sib
->sib_sid_mask
);
2969 sib
->sib_sid
= cpu_to_be64((sid
& mask
) | (u64
) ntohs(port
));
2970 sib
->sib_sid_mask
= cpu_to_be64(~0ULL);
2973 id_priv
->bind_list
= bind_list
;
2974 hlist_add_head(&id_priv
->node
, &bind_list
->owners
);
2977 static int cma_alloc_port(enum rdma_port_space ps
,
2978 struct rdma_id_private
*id_priv
, unsigned short snum
)
2980 struct rdma_bind_list
*bind_list
;
2983 bind_list
= kzalloc(sizeof *bind_list
, GFP_KERNEL
);
2987 ret
= cma_ps_alloc(id_priv
->id
.route
.addr
.dev_addr
.net
, ps
, bind_list
,
2993 bind_list
->port
= (unsigned short)ret
;
2994 cma_bind_port(bind_list
, id_priv
);
2998 return ret
== -ENOSPC
? -EADDRNOTAVAIL
: ret
;
3001 static int cma_port_is_unique(struct rdma_bind_list
*bind_list
,
3002 struct rdma_id_private
*id_priv
)
3004 struct rdma_id_private
*cur_id
;
3005 struct sockaddr
*daddr
= cma_dst_addr(id_priv
);
3006 struct sockaddr
*saddr
= cma_src_addr(id_priv
);
3007 __be16 dport
= cma_port(daddr
);
3009 hlist_for_each_entry(cur_id
, &bind_list
->owners
, node
) {
3010 struct sockaddr
*cur_daddr
= cma_dst_addr(cur_id
);
3011 struct sockaddr
*cur_saddr
= cma_src_addr(cur_id
);
3012 __be16 cur_dport
= cma_port(cur_daddr
);
3014 if (id_priv
== cur_id
)
3017 /* different dest port -> unique */
3018 if (!cma_any_port(cur_daddr
) &&
3019 (dport
!= cur_dport
))
3022 /* different src address -> unique */
3023 if (!cma_any_addr(saddr
) &&
3024 !cma_any_addr(cur_saddr
) &&
3025 cma_addr_cmp(saddr
, cur_saddr
))
3028 /* different dst address -> unique */
3029 if (!cma_any_addr(cur_daddr
) &&
3030 cma_addr_cmp(daddr
, cur_daddr
))
3033 return -EADDRNOTAVAIL
;
3038 static int cma_alloc_any_port(enum rdma_port_space ps
,
3039 struct rdma_id_private
*id_priv
)
3041 static unsigned int last_used_port
;
3042 int low
, high
, remaining
;
3044 struct net
*net
= id_priv
->id
.route
.addr
.dev_addr
.net
;
3046 inet_get_local_port_range(net
, &low
, &high
);
3047 remaining
= (high
- low
) + 1;
3048 rover
= prandom_u32() % remaining
+ low
;
3050 if (last_used_port
!= rover
) {
3051 struct rdma_bind_list
*bind_list
;
3054 bind_list
= cma_ps_find(net
, ps
, (unsigned short)rover
);
3057 ret
= cma_alloc_port(ps
, id_priv
, rover
);
3059 ret
= cma_port_is_unique(bind_list
, id_priv
);
3061 cma_bind_port(bind_list
, id_priv
);
3064 * Remember previously used port number in order to avoid
3065 * re-using same port immediately after it is closed.
3068 last_used_port
= rover
;
3069 if (ret
!= -EADDRNOTAVAIL
)
3074 if ((rover
< low
) || (rover
> high
))
3078 return -EADDRNOTAVAIL
;
3082 * Check that the requested port is available. This is called when trying to
3083 * bind to a specific port, or when trying to listen on a bound port. In
3084 * the latter case, the provided id_priv may already be on the bind_list, but
3085 * we still need to check that it's okay to start listening.
3087 static int cma_check_port(struct rdma_bind_list
*bind_list
,
3088 struct rdma_id_private
*id_priv
, uint8_t reuseaddr
)
3090 struct rdma_id_private
*cur_id
;
3091 struct sockaddr
*addr
, *cur_addr
;
3093 addr
= cma_src_addr(id_priv
);
3094 hlist_for_each_entry(cur_id
, &bind_list
->owners
, node
) {
3095 if (id_priv
== cur_id
)
3098 if ((cur_id
->state
!= RDMA_CM_LISTEN
) && reuseaddr
&&
3102 cur_addr
= cma_src_addr(cur_id
);
3103 if (id_priv
->afonly
&& cur_id
->afonly
&&
3104 (addr
->sa_family
!= cur_addr
->sa_family
))
3107 if (cma_any_addr(addr
) || cma_any_addr(cur_addr
))
3108 return -EADDRNOTAVAIL
;
3110 if (!cma_addr_cmp(addr
, cur_addr
))
3116 static int cma_use_port(enum rdma_port_space ps
,
3117 struct rdma_id_private
*id_priv
)
3119 struct rdma_bind_list
*bind_list
;
3120 unsigned short snum
;
3123 snum
= ntohs(cma_port(cma_src_addr(id_priv
)));
3124 if (snum
< PROT_SOCK
&& !capable(CAP_NET_BIND_SERVICE
))
3127 bind_list
= cma_ps_find(id_priv
->id
.route
.addr
.dev_addr
.net
, ps
, snum
);
3129 ret
= cma_alloc_port(ps
, id_priv
, snum
);
3131 ret
= cma_check_port(bind_list
, id_priv
, id_priv
->reuseaddr
);
3133 cma_bind_port(bind_list
, id_priv
);
3138 static int cma_bind_listen(struct rdma_id_private
*id_priv
)
3140 struct rdma_bind_list
*bind_list
= id_priv
->bind_list
;
3144 if (bind_list
->owners
.first
->next
)
3145 ret
= cma_check_port(bind_list
, id_priv
, 0);
3146 mutex_unlock(&lock
);
3150 static enum rdma_port_space
cma_select_inet_ps(
3151 struct rdma_id_private
*id_priv
)
3153 switch (id_priv
->id
.ps
) {
3158 return id_priv
->id
.ps
;
3165 static enum rdma_port_space
cma_select_ib_ps(struct rdma_id_private
*id_priv
)
3167 enum rdma_port_space ps
= 0;
3168 struct sockaddr_ib
*sib
;
3169 u64 sid_ps
, mask
, sid
;
3171 sib
= (struct sockaddr_ib
*) cma_src_addr(id_priv
);
3172 mask
= be64_to_cpu(sib
->sib_sid_mask
) & RDMA_IB_IP_PS_MASK
;
3173 sid
= be64_to_cpu(sib
->sib_sid
) & mask
;
3175 if ((id_priv
->id
.ps
== RDMA_PS_IB
) && (sid
== (RDMA_IB_IP_PS_IB
& mask
))) {
3176 sid_ps
= RDMA_IB_IP_PS_IB
;
3178 } else if (((id_priv
->id
.ps
== RDMA_PS_IB
) || (id_priv
->id
.ps
== RDMA_PS_TCP
)) &&
3179 (sid
== (RDMA_IB_IP_PS_TCP
& mask
))) {
3180 sid_ps
= RDMA_IB_IP_PS_TCP
;
3182 } else if (((id_priv
->id
.ps
== RDMA_PS_IB
) || (id_priv
->id
.ps
== RDMA_PS_UDP
)) &&
3183 (sid
== (RDMA_IB_IP_PS_UDP
& mask
))) {
3184 sid_ps
= RDMA_IB_IP_PS_UDP
;
3189 sib
->sib_sid
= cpu_to_be64(sid_ps
| ntohs(cma_port((struct sockaddr
*) sib
)));
3190 sib
->sib_sid_mask
= cpu_to_be64(RDMA_IB_IP_PS_MASK
|
3191 be64_to_cpu(sib
->sib_sid_mask
));
3196 static int cma_get_port(struct rdma_id_private
*id_priv
)
3198 enum rdma_port_space ps
;
3201 if (cma_family(id_priv
) != AF_IB
)
3202 ps
= cma_select_inet_ps(id_priv
);
3204 ps
= cma_select_ib_ps(id_priv
);
3206 return -EPROTONOSUPPORT
;
3209 if (cma_any_port(cma_src_addr(id_priv
)))
3210 ret
= cma_alloc_any_port(ps
, id_priv
);
3212 ret
= cma_use_port(ps
, id_priv
);
3213 mutex_unlock(&lock
);
3218 static int cma_check_linklocal(struct rdma_dev_addr
*dev_addr
,
3219 struct sockaddr
*addr
)
3221 #if IS_ENABLED(CONFIG_IPV6)
3222 struct sockaddr_in6
*sin6
;
3224 if (addr
->sa_family
!= AF_INET6
)
3227 sin6
= (struct sockaddr_in6
*) addr
;
3229 if (!(ipv6_addr_type(&sin6
->sin6_addr
) & IPV6_ADDR_LINKLOCAL
))
3232 if (!sin6
->sin6_scope_id
)
3235 dev_addr
->bound_dev_if
= sin6
->sin6_scope_id
;
3240 int rdma_listen(struct rdma_cm_id
*id
, int backlog
)
3242 struct rdma_id_private
*id_priv
;
3245 id_priv
= container_of(id
, struct rdma_id_private
, id
);
3246 if (id_priv
->state
== RDMA_CM_IDLE
) {
3247 id
->route
.addr
.src_addr
.ss_family
= AF_INET
;
3248 ret
= rdma_bind_addr(id
, cma_src_addr(id_priv
));
3253 if (!cma_comp_exch(id_priv
, RDMA_CM_ADDR_BOUND
, RDMA_CM_LISTEN
))
3256 if (id_priv
->reuseaddr
) {
3257 ret
= cma_bind_listen(id_priv
);
3262 id_priv
->backlog
= backlog
;
3264 if (rdma_cap_ib_cm(id
->device
, 1)) {
3265 ret
= cma_ib_listen(id_priv
);
3268 } else if (rdma_cap_iw_cm(id
->device
, 1)) {
3269 ret
= cma_iw_listen(id_priv
, backlog
);
3277 cma_listen_on_all(id_priv
);
3281 id_priv
->backlog
= 0;
3282 cma_comp_exch(id_priv
, RDMA_CM_LISTEN
, RDMA_CM_ADDR_BOUND
);
3285 EXPORT_SYMBOL(rdma_listen
);
3287 int rdma_bind_addr(struct rdma_cm_id
*id
, struct sockaddr
*addr
)
3289 struct rdma_id_private
*id_priv
;
3291 struct sockaddr
*daddr
;
3293 if (addr
->sa_family
!= AF_INET
&& addr
->sa_family
!= AF_INET6
&&
3294 addr
->sa_family
!= AF_IB
)
3295 return -EAFNOSUPPORT
;
3297 id_priv
= container_of(id
, struct rdma_id_private
, id
);
3298 if (!cma_comp_exch(id_priv
, RDMA_CM_IDLE
, RDMA_CM_ADDR_BOUND
))
3301 ret
= cma_check_linklocal(&id
->route
.addr
.dev_addr
, addr
);
3305 memcpy(cma_src_addr(id_priv
), addr
, rdma_addr_size(addr
));
3306 if (!cma_any_addr(addr
)) {
3307 ret
= cma_translate_addr(addr
, &id
->route
.addr
.dev_addr
);
3311 ret
= cma_acquire_dev(id_priv
, NULL
);
3316 if (!(id_priv
->options
& (1 << CMA_OPTION_AFONLY
))) {
3317 if (addr
->sa_family
== AF_INET
)
3318 id_priv
->afonly
= 1;
3319 #if IS_ENABLED(CONFIG_IPV6)
3320 else if (addr
->sa_family
== AF_INET6
) {
3321 struct net
*net
= id_priv
->id
.route
.addr
.dev_addr
.net
;
3323 id_priv
->afonly
= net
->ipv6
.sysctl
.bindv6only
;
3327 ret
= cma_get_port(id_priv
);
3331 daddr
= cma_dst_addr(id_priv
);
3332 daddr
->sa_family
= addr
->sa_family
;
3336 if (id_priv
->cma_dev
)
3337 cma_release_dev(id_priv
);
3339 cma_comp_exch(id_priv
, RDMA_CM_ADDR_BOUND
, RDMA_CM_IDLE
);
3342 EXPORT_SYMBOL(rdma_bind_addr
);
3344 static int cma_format_hdr(void *hdr
, struct rdma_id_private
*id_priv
)
3346 struct cma_hdr
*cma_hdr
;
3349 cma_hdr
->cma_version
= CMA_VERSION
;
3350 if (cma_family(id_priv
) == AF_INET
) {
3351 struct sockaddr_in
*src4
, *dst4
;
3353 src4
= (struct sockaddr_in
*) cma_src_addr(id_priv
);
3354 dst4
= (struct sockaddr_in
*) cma_dst_addr(id_priv
);
3356 cma_set_ip_ver(cma_hdr
, 4);
3357 cma_hdr
->src_addr
.ip4
.addr
= src4
->sin_addr
.s_addr
;
3358 cma_hdr
->dst_addr
.ip4
.addr
= dst4
->sin_addr
.s_addr
;
3359 cma_hdr
->port
= src4
->sin_port
;
3360 } else if (cma_family(id_priv
) == AF_INET6
) {
3361 struct sockaddr_in6
*src6
, *dst6
;
3363 src6
= (struct sockaddr_in6
*) cma_src_addr(id_priv
);
3364 dst6
= (struct sockaddr_in6
*) cma_dst_addr(id_priv
);
3366 cma_set_ip_ver(cma_hdr
, 6);
3367 cma_hdr
->src_addr
.ip6
= src6
->sin6_addr
;
3368 cma_hdr
->dst_addr
.ip6
= dst6
->sin6_addr
;
3369 cma_hdr
->port
= src6
->sin6_port
;
3374 static int cma_sidr_rep_handler(struct ib_cm_id
*cm_id
,
3375 struct ib_cm_event
*ib_event
)
3377 struct rdma_id_private
*id_priv
= cm_id
->context
;
3378 struct rdma_cm_event event
;
3379 struct ib_cm_sidr_rep_event_param
*rep
= &ib_event
->param
.sidr_rep_rcvd
;
3382 mutex_lock(&id_priv
->handler_mutex
);
3383 if (id_priv
->state
!= RDMA_CM_CONNECT
)
3386 memset(&event
, 0, sizeof event
);
3387 switch (ib_event
->event
) {
3388 case IB_CM_SIDR_REQ_ERROR
:
3389 event
.event
= RDMA_CM_EVENT_UNREACHABLE
;
3390 event
.status
= -ETIMEDOUT
;
3392 case IB_CM_SIDR_REP_RECEIVED
:
3393 event
.param
.ud
.private_data
= ib_event
->private_data
;
3394 event
.param
.ud
.private_data_len
= IB_CM_SIDR_REP_PRIVATE_DATA_SIZE
;
3395 if (rep
->status
!= IB_SIDR_SUCCESS
) {
3396 event
.event
= RDMA_CM_EVENT_UNREACHABLE
;
3397 event
.status
= ib_event
->param
.sidr_rep_rcvd
.status
;
3398 pr_debug_ratelimited("RDMA CM: UNREACHABLE: bad SIDR reply. status %d\n",
3402 ret
= cma_set_qkey(id_priv
, rep
->qkey
);
3404 pr_debug_ratelimited("RDMA CM: ADDR_ERROR: failed to set qkey. status %d\n", ret
);
3405 event
.event
= RDMA_CM_EVENT_ADDR_ERROR
;
3409 ib_init_ah_from_path(id_priv
->id
.device
, id_priv
->id
.port_num
,
3410 id_priv
->id
.route
.path_rec
,
3411 &event
.param
.ud
.ah_attr
);
3412 event
.param
.ud
.qp_num
= rep
->qpn
;
3413 event
.param
.ud
.qkey
= rep
->qkey
;
3414 event
.event
= RDMA_CM_EVENT_ESTABLISHED
;
3418 pr_err("RDMA CMA: unexpected IB CM event: %d\n",
3423 ret
= id_priv
->id
.event_handler(&id_priv
->id
, &event
);
3425 /* Destroy the CM ID by returning a non-zero value. */
3426 id_priv
->cm_id
.ib
= NULL
;
3427 cma_exch(id_priv
, RDMA_CM_DESTROYING
);
3428 mutex_unlock(&id_priv
->handler_mutex
);
3429 rdma_destroy_id(&id_priv
->id
);
3433 mutex_unlock(&id_priv
->handler_mutex
);
3437 static int cma_resolve_ib_udp(struct rdma_id_private
*id_priv
,
3438 struct rdma_conn_param
*conn_param
)
3440 struct ib_cm_sidr_req_param req
;
3441 struct ib_cm_id
*id
;
3445 memset(&req
, 0, sizeof req
);
3446 offset
= cma_user_data_offset(id_priv
);
3447 req
.private_data_len
= offset
+ conn_param
->private_data_len
;
3448 if (req
.private_data_len
< conn_param
->private_data_len
)
3451 if (req
.private_data_len
) {
3452 private_data
= kzalloc(req
.private_data_len
, GFP_ATOMIC
);
3456 private_data
= NULL
;
3459 if (conn_param
->private_data
&& conn_param
->private_data_len
)
3460 memcpy(private_data
+ offset
, conn_param
->private_data
,
3461 conn_param
->private_data_len
);
3464 ret
= cma_format_hdr(private_data
, id_priv
);
3467 req
.private_data
= private_data
;
3470 id
= ib_create_cm_id(id_priv
->id
.device
, cma_sidr_rep_handler
,
3476 id_priv
->cm_id
.ib
= id
;
3478 req
.path
= id_priv
->id
.route
.path_rec
;
3479 req
.service_id
= rdma_get_service_id(&id_priv
->id
, cma_dst_addr(id_priv
));
3480 req
.timeout_ms
= 1 << (CMA_CM_RESPONSE_TIMEOUT
- 8);
3481 req
.max_cm_retries
= CMA_MAX_CM_RETRIES
;
3483 ret
= ib_send_cm_sidr_req(id_priv
->cm_id
.ib
, &req
);
3485 ib_destroy_cm_id(id_priv
->cm_id
.ib
);
3486 id_priv
->cm_id
.ib
= NULL
;
3489 kfree(private_data
);
3493 static int cma_connect_ib(struct rdma_id_private
*id_priv
,
3494 struct rdma_conn_param
*conn_param
)
3496 struct ib_cm_req_param req
;
3497 struct rdma_route
*route
;
3499 struct ib_cm_id
*id
;
3502 memset(&req
, 0, sizeof req
);
3503 offset
= cma_user_data_offset(id_priv
);
3504 req
.private_data_len
= offset
+ conn_param
->private_data_len
;
3505 if (req
.private_data_len
< conn_param
->private_data_len
)
3508 if (req
.private_data_len
) {
3509 private_data
= kzalloc(req
.private_data_len
, GFP_ATOMIC
);
3513 private_data
= NULL
;
3516 if (conn_param
->private_data
&& conn_param
->private_data_len
)
3517 memcpy(private_data
+ offset
, conn_param
->private_data
,
3518 conn_param
->private_data_len
);
3520 id
= ib_create_cm_id(id_priv
->id
.device
, cma_ib_handler
, id_priv
);
3525 id_priv
->cm_id
.ib
= id
;
3527 route
= &id_priv
->id
.route
;
3529 ret
= cma_format_hdr(private_data
, id_priv
);
3532 req
.private_data
= private_data
;
3535 req
.primary_path
= &route
->path_rec
[0];
3536 if (route
->num_paths
== 2)
3537 req
.alternate_path
= &route
->path_rec
[1];
3539 req
.service_id
= rdma_get_service_id(&id_priv
->id
, cma_dst_addr(id_priv
));
3540 req
.qp_num
= id_priv
->qp_num
;
3541 req
.qp_type
= id_priv
->id
.qp_type
;
3542 req
.starting_psn
= id_priv
->seq_num
;
3543 req
.responder_resources
= conn_param
->responder_resources
;
3544 req
.initiator_depth
= conn_param
->initiator_depth
;
3545 req
.flow_control
= conn_param
->flow_control
;
3546 req
.retry_count
= min_t(u8
, 7, conn_param
->retry_count
);
3547 req
.rnr_retry_count
= min_t(u8
, 7, conn_param
->rnr_retry_count
);
3548 req
.remote_cm_response_timeout
= CMA_CM_RESPONSE_TIMEOUT
;
3549 req
.local_cm_response_timeout
= CMA_CM_RESPONSE_TIMEOUT
;
3550 req
.max_cm_retries
= CMA_MAX_CM_RETRIES
;
3551 req
.srq
= id_priv
->srq
? 1 : 0;
3553 ret
= ib_send_cm_req(id_priv
->cm_id
.ib
, &req
);
3555 if (ret
&& !IS_ERR(id
)) {
3556 ib_destroy_cm_id(id
);
3557 id_priv
->cm_id
.ib
= NULL
;
3560 kfree(private_data
);
3564 static int cma_connect_iw(struct rdma_id_private
*id_priv
,
3565 struct rdma_conn_param
*conn_param
)
3567 struct iw_cm_id
*cm_id
;
3569 struct iw_cm_conn_param iw_param
;
3571 cm_id
= iw_create_cm_id(id_priv
->id
.device
, cma_iw_handler
, id_priv
);
3573 return PTR_ERR(cm_id
);
3575 cm_id
->tos
= id_priv
->tos
;
3576 id_priv
->cm_id
.iw
= cm_id
;
3578 memcpy(&cm_id
->local_addr
, cma_src_addr(id_priv
),
3579 rdma_addr_size(cma_src_addr(id_priv
)));
3580 memcpy(&cm_id
->remote_addr
, cma_dst_addr(id_priv
),
3581 rdma_addr_size(cma_dst_addr(id_priv
)));
3583 ret
= cma_modify_qp_rtr(id_priv
, conn_param
);
3588 iw_param
.ord
= conn_param
->initiator_depth
;
3589 iw_param
.ird
= conn_param
->responder_resources
;
3590 iw_param
.private_data
= conn_param
->private_data
;
3591 iw_param
.private_data_len
= conn_param
->private_data_len
;
3592 iw_param
.qpn
= id_priv
->id
.qp
? id_priv
->qp_num
: conn_param
->qp_num
;
3594 memset(&iw_param
, 0, sizeof iw_param
);
3595 iw_param
.qpn
= id_priv
->qp_num
;
3597 ret
= iw_cm_connect(cm_id
, &iw_param
);
3600 iw_destroy_cm_id(cm_id
);
3601 id_priv
->cm_id
.iw
= NULL
;
3606 int rdma_connect(struct rdma_cm_id
*id
, struct rdma_conn_param
*conn_param
)
3608 struct rdma_id_private
*id_priv
;
3611 id_priv
= container_of(id
, struct rdma_id_private
, id
);
3612 if (!cma_comp_exch(id_priv
, RDMA_CM_ROUTE_RESOLVED
, RDMA_CM_CONNECT
))
3616 id_priv
->qp_num
= conn_param
->qp_num
;
3617 id_priv
->srq
= conn_param
->srq
;
3620 if (rdma_cap_ib_cm(id
->device
, id
->port_num
)) {
3621 if (id
->qp_type
== IB_QPT_UD
)
3622 ret
= cma_resolve_ib_udp(id_priv
, conn_param
);
3624 ret
= cma_connect_ib(id_priv
, conn_param
);
3625 } else if (rdma_cap_iw_cm(id
->device
, id
->port_num
))
3626 ret
= cma_connect_iw(id_priv
, conn_param
);
3634 cma_comp_exch(id_priv
, RDMA_CM_CONNECT
, RDMA_CM_ROUTE_RESOLVED
);
3637 EXPORT_SYMBOL(rdma_connect
);
3639 static int cma_accept_ib(struct rdma_id_private
*id_priv
,
3640 struct rdma_conn_param
*conn_param
)
3642 struct ib_cm_rep_param rep
;
3645 ret
= cma_modify_qp_rtr(id_priv
, conn_param
);
3649 ret
= cma_modify_qp_rts(id_priv
, conn_param
);
3653 memset(&rep
, 0, sizeof rep
);
3654 rep
.qp_num
= id_priv
->qp_num
;
3655 rep
.starting_psn
= id_priv
->seq_num
;
3656 rep
.private_data
= conn_param
->private_data
;
3657 rep
.private_data_len
= conn_param
->private_data_len
;
3658 rep
.responder_resources
= conn_param
->responder_resources
;
3659 rep
.initiator_depth
= conn_param
->initiator_depth
;
3660 rep
.failover_accepted
= 0;
3661 rep
.flow_control
= conn_param
->flow_control
;
3662 rep
.rnr_retry_count
= min_t(u8
, 7, conn_param
->rnr_retry_count
);
3663 rep
.srq
= id_priv
->srq
? 1 : 0;
3665 ret
= ib_send_cm_rep(id_priv
->cm_id
.ib
, &rep
);
3670 static int cma_accept_iw(struct rdma_id_private
*id_priv
,
3671 struct rdma_conn_param
*conn_param
)
3673 struct iw_cm_conn_param iw_param
;
3679 ret
= cma_modify_qp_rtr(id_priv
, conn_param
);
3683 iw_param
.ord
= conn_param
->initiator_depth
;
3684 iw_param
.ird
= conn_param
->responder_resources
;
3685 iw_param
.private_data
= conn_param
->private_data
;
3686 iw_param
.private_data_len
= conn_param
->private_data_len
;
3687 if (id_priv
->id
.qp
) {
3688 iw_param
.qpn
= id_priv
->qp_num
;
3690 iw_param
.qpn
= conn_param
->qp_num
;
3692 return iw_cm_accept(id_priv
->cm_id
.iw
, &iw_param
);
3695 static int cma_send_sidr_rep(struct rdma_id_private
*id_priv
,
3696 enum ib_cm_sidr_status status
, u32 qkey
,
3697 const void *private_data
, int private_data_len
)
3699 struct ib_cm_sidr_rep_param rep
;
3702 memset(&rep
, 0, sizeof rep
);
3703 rep
.status
= status
;
3704 if (status
== IB_SIDR_SUCCESS
) {
3705 ret
= cma_set_qkey(id_priv
, qkey
);
3708 rep
.qp_num
= id_priv
->qp_num
;
3709 rep
.qkey
= id_priv
->qkey
;
3711 rep
.private_data
= private_data
;
3712 rep
.private_data_len
= private_data_len
;
3714 return ib_send_cm_sidr_rep(id_priv
->cm_id
.ib
, &rep
);
3717 int rdma_accept(struct rdma_cm_id
*id
, struct rdma_conn_param
*conn_param
)
3719 struct rdma_id_private
*id_priv
;
3722 id_priv
= container_of(id
, struct rdma_id_private
, id
);
3724 id_priv
->owner
= task_pid_nr(current
);
3726 if (!cma_comp(id_priv
, RDMA_CM_CONNECT
))
3729 if (!id
->qp
&& conn_param
) {
3730 id_priv
->qp_num
= conn_param
->qp_num
;
3731 id_priv
->srq
= conn_param
->srq
;
3734 if (rdma_cap_ib_cm(id
->device
, id
->port_num
)) {
3735 if (id
->qp_type
== IB_QPT_UD
) {
3737 ret
= cma_send_sidr_rep(id_priv
, IB_SIDR_SUCCESS
,
3739 conn_param
->private_data
,
3740 conn_param
->private_data_len
);
3742 ret
= cma_send_sidr_rep(id_priv
, IB_SIDR_SUCCESS
,
3746 ret
= cma_accept_ib(id_priv
, conn_param
);
3748 ret
= cma_rep_recv(id_priv
);
3750 } else if (rdma_cap_iw_cm(id
->device
, id
->port_num
))
3751 ret
= cma_accept_iw(id_priv
, conn_param
);
3760 cma_modify_qp_err(id_priv
);
3761 rdma_reject(id
, NULL
, 0);
3764 EXPORT_SYMBOL(rdma_accept
);
3766 int rdma_notify(struct rdma_cm_id
*id
, enum ib_event_type event
)
3768 struct rdma_id_private
*id_priv
;
3771 id_priv
= container_of(id
, struct rdma_id_private
, id
);
3772 if (!id_priv
->cm_id
.ib
)
3775 switch (id
->device
->node_type
) {
3776 case RDMA_NODE_IB_CA
:
3777 ret
= ib_cm_notify(id_priv
->cm_id
.ib
, event
);
3785 EXPORT_SYMBOL(rdma_notify
);
3787 int rdma_reject(struct rdma_cm_id
*id
, const void *private_data
,
3788 u8 private_data_len
)
3790 struct rdma_id_private
*id_priv
;
3793 id_priv
= container_of(id
, struct rdma_id_private
, id
);
3794 if (!id_priv
->cm_id
.ib
)
3797 if (rdma_cap_ib_cm(id
->device
, id
->port_num
)) {
3798 if (id
->qp_type
== IB_QPT_UD
)
3799 ret
= cma_send_sidr_rep(id_priv
, IB_SIDR_REJECT
, 0,
3800 private_data
, private_data_len
);
3802 ret
= ib_send_cm_rej(id_priv
->cm_id
.ib
,
3803 IB_CM_REJ_CONSUMER_DEFINED
, NULL
,
3804 0, private_data
, private_data_len
);
3805 } else if (rdma_cap_iw_cm(id
->device
, id
->port_num
)) {
3806 ret
= iw_cm_reject(id_priv
->cm_id
.iw
,
3807 private_data
, private_data_len
);
3813 EXPORT_SYMBOL(rdma_reject
);
3815 int rdma_disconnect(struct rdma_cm_id
*id
)
3817 struct rdma_id_private
*id_priv
;
3820 id_priv
= container_of(id
, struct rdma_id_private
, id
);
3821 if (!id_priv
->cm_id
.ib
)
3824 if (rdma_cap_ib_cm(id
->device
, id
->port_num
)) {
3825 ret
= cma_modify_qp_err(id_priv
);
3828 /* Initiate or respond to a disconnect. */
3829 if (ib_send_cm_dreq(id_priv
->cm_id
.ib
, NULL
, 0))
3830 ib_send_cm_drep(id_priv
->cm_id
.ib
, NULL
, 0);
3831 } else if (rdma_cap_iw_cm(id
->device
, id
->port_num
)) {
3832 ret
= iw_cm_disconnect(id_priv
->cm_id
.iw
, 0);
3839 EXPORT_SYMBOL(rdma_disconnect
);
3841 static int cma_ib_mc_handler(int status
, struct ib_sa_multicast
*multicast
)
3843 struct rdma_id_private
*id_priv
;
3844 struct cma_multicast
*mc
= multicast
->context
;
3845 struct rdma_cm_event event
;
3848 id_priv
= mc
->id_priv
;
3849 mutex_lock(&id_priv
->handler_mutex
);
3850 if (id_priv
->state
!= RDMA_CM_ADDR_BOUND
&&
3851 id_priv
->state
!= RDMA_CM_ADDR_RESOLVED
)
3855 status
= cma_set_qkey(id_priv
, be32_to_cpu(multicast
->rec
.qkey
));
3857 pr_debug_ratelimited("RDMA CM: MULTICAST_ERROR: failed to join multicast. status %d\n",
3859 mutex_lock(&id_priv
->qp_mutex
);
3860 if (!status
&& id_priv
->id
.qp
) {
3861 status
= ib_attach_mcast(id_priv
->id
.qp
, &multicast
->rec
.mgid
,
3862 be16_to_cpu(multicast
->rec
.mlid
));
3864 pr_debug_ratelimited("RDMA CM: MULTICAST_ERROR: failed to attach QP. status %d\n",
3867 mutex_unlock(&id_priv
->qp_mutex
);
3869 memset(&event
, 0, sizeof event
);
3870 event
.status
= status
;
3871 event
.param
.ud
.private_data
= mc
->context
;
3873 struct rdma_dev_addr
*dev_addr
=
3874 &id_priv
->id
.route
.addr
.dev_addr
;
3875 struct net_device
*ndev
=
3876 dev_get_by_index(&init_net
, dev_addr
->bound_dev_if
);
3877 enum ib_gid_type gid_type
=
3878 id_priv
->cma_dev
->default_gid_type
[id_priv
->id
.port_num
-
3879 rdma_start_port(id_priv
->cma_dev
->device
)];
3881 event
.event
= RDMA_CM_EVENT_MULTICAST_JOIN
;
3882 ib_init_ah_from_mcmember(id_priv
->id
.device
,
3883 id_priv
->id
.port_num
, &multicast
->rec
,
3885 &event
.param
.ud
.ah_attr
);
3886 event
.param
.ud
.qp_num
= 0xFFFFFF;
3887 event
.param
.ud
.qkey
= be32_to_cpu(multicast
->rec
.qkey
);
3891 event
.event
= RDMA_CM_EVENT_MULTICAST_ERROR
;
3893 ret
= id_priv
->id
.event_handler(&id_priv
->id
, &event
);
3895 cma_exch(id_priv
, RDMA_CM_DESTROYING
);
3896 mutex_unlock(&id_priv
->handler_mutex
);
3897 rdma_destroy_id(&id_priv
->id
);
3902 mutex_unlock(&id_priv
->handler_mutex
);
3906 static void cma_set_mgid(struct rdma_id_private
*id_priv
,
3907 struct sockaddr
*addr
, union ib_gid
*mgid
)
3909 unsigned char mc_map
[MAX_ADDR_LEN
];
3910 struct rdma_dev_addr
*dev_addr
= &id_priv
->id
.route
.addr
.dev_addr
;
3911 struct sockaddr_in
*sin
= (struct sockaddr_in
*) addr
;
3912 struct sockaddr_in6
*sin6
= (struct sockaddr_in6
*) addr
;
3914 if (cma_any_addr(addr
)) {
3915 memset(mgid
, 0, sizeof *mgid
);
3916 } else if ((addr
->sa_family
== AF_INET6
) &&
3917 ((be32_to_cpu(sin6
->sin6_addr
.s6_addr32
[0]) & 0xFFF0FFFF) ==
3919 /* IPv6 address is an SA assigned MGID. */
3920 memcpy(mgid
, &sin6
->sin6_addr
, sizeof *mgid
);
3921 } else if (addr
->sa_family
== AF_IB
) {
3922 memcpy(mgid
, &((struct sockaddr_ib
*) addr
)->sib_addr
, sizeof *mgid
);
3923 } else if ((addr
->sa_family
== AF_INET6
)) {
3924 ipv6_ib_mc_map(&sin6
->sin6_addr
, dev_addr
->broadcast
, mc_map
);
3925 if (id_priv
->id
.ps
== RDMA_PS_UDP
)
3926 mc_map
[7] = 0x01; /* Use RDMA CM signature */
3927 *mgid
= *(union ib_gid
*) (mc_map
+ 4);
3929 ip_ib_mc_map(sin
->sin_addr
.s_addr
, dev_addr
->broadcast
, mc_map
);
3930 if (id_priv
->id
.ps
== RDMA_PS_UDP
)
3931 mc_map
[7] = 0x01; /* Use RDMA CM signature */
3932 *mgid
= *(union ib_gid
*) (mc_map
+ 4);
3936 static int cma_join_ib_multicast(struct rdma_id_private
*id_priv
,
3937 struct cma_multicast
*mc
)
3939 struct ib_sa_mcmember_rec rec
;
3940 struct rdma_dev_addr
*dev_addr
= &id_priv
->id
.route
.addr
.dev_addr
;
3941 ib_sa_comp_mask comp_mask
;
3944 ib_addr_get_mgid(dev_addr
, &rec
.mgid
);
3945 ret
= ib_sa_get_mcmember_rec(id_priv
->id
.device
, id_priv
->id
.port_num
,
3950 ret
= cma_set_qkey(id_priv
, 0);
3954 cma_set_mgid(id_priv
, (struct sockaddr
*) &mc
->addr
, &rec
.mgid
);
3955 rec
.qkey
= cpu_to_be32(id_priv
->qkey
);
3956 rdma_addr_get_sgid(dev_addr
, &rec
.port_gid
);
3957 rec
.pkey
= cpu_to_be16(ib_addr_get_pkey(dev_addr
));
3958 rec
.join_state
= mc
->join_state
;
3960 if ((rec
.join_state
== BIT(SENDONLY_FULLMEMBER_JOIN
)) &&
3961 (!ib_sa_sendonly_fullmem_support(&sa_client
,
3963 id_priv
->id
.port_num
))) {
3964 pr_warn("RDMA CM: %s port %u Unable to multicast join\n"
3965 "RDMA CM: SM doesn't support Send Only Full Member option\n",
3966 id_priv
->id
.device
->name
, id_priv
->id
.port_num
);
3970 comp_mask
= IB_SA_MCMEMBER_REC_MGID
| IB_SA_MCMEMBER_REC_PORT_GID
|
3971 IB_SA_MCMEMBER_REC_PKEY
| IB_SA_MCMEMBER_REC_JOIN_STATE
|
3972 IB_SA_MCMEMBER_REC_QKEY
| IB_SA_MCMEMBER_REC_SL
|
3973 IB_SA_MCMEMBER_REC_FLOW_LABEL
|
3974 IB_SA_MCMEMBER_REC_TRAFFIC_CLASS
;
3976 if (id_priv
->id
.ps
== RDMA_PS_IPOIB
)
3977 comp_mask
|= IB_SA_MCMEMBER_REC_RATE
|
3978 IB_SA_MCMEMBER_REC_RATE_SELECTOR
|
3979 IB_SA_MCMEMBER_REC_MTU_SELECTOR
|
3980 IB_SA_MCMEMBER_REC_MTU
|
3981 IB_SA_MCMEMBER_REC_HOP_LIMIT
;
3983 mc
->multicast
.ib
= ib_sa_join_multicast(&sa_client
, id_priv
->id
.device
,
3984 id_priv
->id
.port_num
, &rec
,
3985 comp_mask
, GFP_KERNEL
,
3986 cma_ib_mc_handler
, mc
);
3987 return PTR_ERR_OR_ZERO(mc
->multicast
.ib
);
3990 static void iboe_mcast_work_handler(struct work_struct
*work
)
3992 struct iboe_mcast_work
*mw
= container_of(work
, struct iboe_mcast_work
, work
);
3993 struct cma_multicast
*mc
= mw
->mc
;
3994 struct ib_sa_multicast
*m
= mc
->multicast
.ib
;
3996 mc
->multicast
.ib
->context
= mc
;
3997 cma_ib_mc_handler(0, m
);
3998 kref_put(&mc
->mcref
, release_mc
);
4002 static void cma_iboe_set_mgid(struct sockaddr
*addr
, union ib_gid
*mgid
,
4003 enum ib_gid_type gid_type
)
4005 struct sockaddr_in
*sin
= (struct sockaddr_in
*)addr
;
4006 struct sockaddr_in6
*sin6
= (struct sockaddr_in6
*)addr
;
4008 if (cma_any_addr(addr
)) {
4009 memset(mgid
, 0, sizeof *mgid
);
4010 } else if (addr
->sa_family
== AF_INET6
) {
4011 memcpy(mgid
, &sin6
->sin6_addr
, sizeof *mgid
);
4013 mgid
->raw
[0] = (gid_type
== IB_GID_TYPE_IB
) ? 0xff : 0;
4014 mgid
->raw
[1] = (gid_type
== IB_GID_TYPE_IB
) ? 0x0e : 0;
4023 mgid
->raw
[10] = 0xff;
4024 mgid
->raw
[11] = 0xff;
4025 *(__be32
*)(&mgid
->raw
[12]) = sin
->sin_addr
.s_addr
;
4029 static int cma_iboe_join_multicast(struct rdma_id_private
*id_priv
,
4030 struct cma_multicast
*mc
)
4032 struct iboe_mcast_work
*work
;
4033 struct rdma_dev_addr
*dev_addr
= &id_priv
->id
.route
.addr
.dev_addr
;
4035 struct sockaddr
*addr
= (struct sockaddr
*)&mc
->addr
;
4036 struct net_device
*ndev
= NULL
;
4037 enum ib_gid_type gid_type
;
4040 send_only
= mc
->join_state
== BIT(SENDONLY_FULLMEMBER_JOIN
);
4042 if (cma_zero_addr((struct sockaddr
*)&mc
->addr
))
4045 work
= kzalloc(sizeof *work
, GFP_KERNEL
);
4049 mc
->multicast
.ib
= kzalloc(sizeof(struct ib_sa_multicast
), GFP_KERNEL
);
4050 if (!mc
->multicast
.ib
) {
4055 gid_type
= id_priv
->cma_dev
->default_gid_type
[id_priv
->id
.port_num
-
4056 rdma_start_port(id_priv
->cma_dev
->device
)];
4057 cma_iboe_set_mgid(addr
, &mc
->multicast
.ib
->rec
.mgid
, gid_type
);
4059 mc
->multicast
.ib
->rec
.pkey
= cpu_to_be16(0xffff);
4060 if (id_priv
->id
.ps
== RDMA_PS_UDP
)
4061 mc
->multicast
.ib
->rec
.qkey
= cpu_to_be32(RDMA_UDP_QKEY
);
4063 if (dev_addr
->bound_dev_if
)
4064 ndev
= dev_get_by_index(&init_net
, dev_addr
->bound_dev_if
);
4069 mc
->multicast
.ib
->rec
.rate
= iboe_get_rate(ndev
);
4070 mc
->multicast
.ib
->rec
.hop_limit
= 1;
4071 mc
->multicast
.ib
->rec
.mtu
= iboe_get_mtu(ndev
->mtu
);
4073 if (addr
->sa_family
== AF_INET
) {
4074 if (gid_type
== IB_GID_TYPE_ROCE_UDP_ENCAP
) {
4075 mc
->multicast
.ib
->rec
.hop_limit
= IPV6_DEFAULT_HOPLIMIT
;
4077 err
= cma_igmp_send(ndev
, &mc
->multicast
.ib
->rec
.mgid
,
4080 mc
->igmp_joined
= true;
4084 if (gid_type
== IB_GID_TYPE_ROCE_UDP_ENCAP
)
4088 if (err
|| !mc
->multicast
.ib
->rec
.mtu
) {
4093 rdma_ip2gid((struct sockaddr
*)&id_priv
->id
.route
.addr
.src_addr
,
4094 &mc
->multicast
.ib
->rec
.port_gid
);
4097 INIT_WORK(&work
->work
, iboe_mcast_work_handler
);
4098 kref_get(&mc
->mcref
);
4099 queue_work(cma_wq
, &work
->work
);
4104 kfree(mc
->multicast
.ib
);
4110 int rdma_join_multicast(struct rdma_cm_id
*id
, struct sockaddr
*addr
,
4111 u8 join_state
, void *context
)
4113 struct rdma_id_private
*id_priv
;
4114 struct cma_multicast
*mc
;
4117 id_priv
= container_of(id
, struct rdma_id_private
, id
);
4118 if (!cma_comp(id_priv
, RDMA_CM_ADDR_BOUND
) &&
4119 !cma_comp(id_priv
, RDMA_CM_ADDR_RESOLVED
))
4122 mc
= kmalloc(sizeof *mc
, GFP_KERNEL
);
4126 memcpy(&mc
->addr
, addr
, rdma_addr_size(addr
));
4127 mc
->context
= context
;
4128 mc
->id_priv
= id_priv
;
4129 mc
->igmp_joined
= false;
4130 mc
->join_state
= join_state
;
4131 spin_lock(&id_priv
->lock
);
4132 list_add(&mc
->list
, &id_priv
->mc_list
);
4133 spin_unlock(&id_priv
->lock
);
4135 if (rdma_protocol_roce(id
->device
, id
->port_num
)) {
4136 kref_init(&mc
->mcref
);
4137 ret
= cma_iboe_join_multicast(id_priv
, mc
);
4138 } else if (rdma_cap_ib_mcast(id
->device
, id
->port_num
))
4139 ret
= cma_join_ib_multicast(id_priv
, mc
);
4144 spin_lock_irq(&id_priv
->lock
);
4145 list_del(&mc
->list
);
4146 spin_unlock_irq(&id_priv
->lock
);
4151 EXPORT_SYMBOL(rdma_join_multicast
);
4153 void rdma_leave_multicast(struct rdma_cm_id
*id
, struct sockaddr
*addr
)
4155 struct rdma_id_private
*id_priv
;
4156 struct cma_multicast
*mc
;
4158 id_priv
= container_of(id
, struct rdma_id_private
, id
);
4159 spin_lock_irq(&id_priv
->lock
);
4160 list_for_each_entry(mc
, &id_priv
->mc_list
, list
) {
4161 if (!memcmp(&mc
->addr
, addr
, rdma_addr_size(addr
))) {
4162 list_del(&mc
->list
);
4163 spin_unlock_irq(&id_priv
->lock
);
4166 ib_detach_mcast(id
->qp
,
4167 &mc
->multicast
.ib
->rec
.mgid
,
4168 be16_to_cpu(mc
->multicast
.ib
->rec
.mlid
));
4170 BUG_ON(id_priv
->cma_dev
->device
!= id
->device
);
4172 if (rdma_cap_ib_mcast(id
->device
, id
->port_num
)) {
4173 ib_sa_free_multicast(mc
->multicast
.ib
);
4175 } else if (rdma_protocol_roce(id
->device
, id
->port_num
)) {
4176 if (mc
->igmp_joined
) {
4177 struct rdma_dev_addr
*dev_addr
=
4178 &id
->route
.addr
.dev_addr
;
4179 struct net_device
*ndev
= NULL
;
4181 if (dev_addr
->bound_dev_if
)
4182 ndev
= dev_get_by_index(&init_net
,
4183 dev_addr
->bound_dev_if
);
4186 &mc
->multicast
.ib
->rec
.mgid
,
4190 mc
->igmp_joined
= false;
4192 kref_put(&mc
->mcref
, release_mc
);
4197 spin_unlock_irq(&id_priv
->lock
);
4199 EXPORT_SYMBOL(rdma_leave_multicast
);
4201 static int cma_netdev_change(struct net_device
*ndev
, struct rdma_id_private
*id_priv
)
4203 struct rdma_dev_addr
*dev_addr
;
4204 struct cma_ndev_work
*work
;
4206 dev_addr
= &id_priv
->id
.route
.addr
.dev_addr
;
4208 if ((dev_addr
->bound_dev_if
== ndev
->ifindex
) &&
4209 (net_eq(dev_net(ndev
), dev_addr
->net
)) &&
4210 memcmp(dev_addr
->src_dev_addr
, ndev
->dev_addr
, ndev
->addr_len
)) {
4211 pr_info("RDMA CM addr change for ndev %s used by id %p\n",
4212 ndev
->name
, &id_priv
->id
);
4213 work
= kzalloc(sizeof *work
, GFP_KERNEL
);
4217 INIT_WORK(&work
->work
, cma_ndev_work_handler
);
4219 work
->event
.event
= RDMA_CM_EVENT_ADDR_CHANGE
;
4220 atomic_inc(&id_priv
->refcount
);
4221 queue_work(cma_wq
, &work
->work
);
4227 static int cma_netdev_callback(struct notifier_block
*self
, unsigned long event
,
4230 struct net_device
*ndev
= netdev_notifier_info_to_dev(ptr
);
4231 struct cma_device
*cma_dev
;
4232 struct rdma_id_private
*id_priv
;
4233 int ret
= NOTIFY_DONE
;
4235 if (event
!= NETDEV_BONDING_FAILOVER
)
4238 if (!(ndev
->flags
& IFF_MASTER
) || !(ndev
->priv_flags
& IFF_BONDING
))
4242 list_for_each_entry(cma_dev
, &dev_list
, list
)
4243 list_for_each_entry(id_priv
, &cma_dev
->id_list
, list
) {
4244 ret
= cma_netdev_change(ndev
, id_priv
);
4250 mutex_unlock(&lock
);
4254 static struct notifier_block cma_nb
= {
4255 .notifier_call
= cma_netdev_callback
4258 static void cma_add_one(struct ib_device
*device
)
4260 struct cma_device
*cma_dev
;
4261 struct rdma_id_private
*id_priv
;
4263 unsigned long supported_gids
= 0;
4265 cma_dev
= kmalloc(sizeof *cma_dev
, GFP_KERNEL
);
4269 cma_dev
->device
= device
;
4270 cma_dev
->default_gid_type
= kcalloc(device
->phys_port_cnt
,
4271 sizeof(*cma_dev
->default_gid_type
),
4273 if (!cma_dev
->default_gid_type
)
4276 cma_dev
->default_roce_tos
= kcalloc(device
->phys_port_cnt
,
4277 sizeof(*cma_dev
->default_roce_tos
),
4279 if (!cma_dev
->default_roce_tos
)
4282 for (i
= rdma_start_port(device
); i
<= rdma_end_port(device
); i
++) {
4283 supported_gids
= roce_gid_type_mask_support(device
, i
);
4284 WARN_ON(!supported_gids
);
4285 if (supported_gids
& CMA_PREFERRED_ROCE_GID_TYPE
)
4286 cma_dev
->default_gid_type
[i
- rdma_start_port(device
)] =
4287 CMA_PREFERRED_ROCE_GID_TYPE
;
4289 cma_dev
->default_gid_type
[i
- rdma_start_port(device
)] =
4290 find_first_bit(&supported_gids
, BITS_PER_LONG
);
4291 cma_dev
->default_roce_tos
[i
- rdma_start_port(device
)] = 0;
4294 init_completion(&cma_dev
->comp
);
4295 atomic_set(&cma_dev
->refcount
, 1);
4296 INIT_LIST_HEAD(&cma_dev
->id_list
);
4297 ib_set_client_data(device
, &cma_client
, cma_dev
);
4300 list_add_tail(&cma_dev
->list
, &dev_list
);
4301 list_for_each_entry(id_priv
, &listen_any_list
, list
)
4302 cma_listen_on_dev(id_priv
, cma_dev
);
4303 mutex_unlock(&lock
);
4308 kfree(cma_dev
->default_gid_type
);
4316 static int cma_remove_id_dev(struct rdma_id_private
*id_priv
)
4318 struct rdma_cm_event event
;
4319 enum rdma_cm_state state
;
4322 /* Record that we want to remove the device */
4323 state
= cma_exch(id_priv
, RDMA_CM_DEVICE_REMOVAL
);
4324 if (state
== RDMA_CM_DESTROYING
)
4327 cma_cancel_operation(id_priv
, state
);
4328 mutex_lock(&id_priv
->handler_mutex
);
4330 /* Check for destruction from another callback. */
4331 if (!cma_comp(id_priv
, RDMA_CM_DEVICE_REMOVAL
))
4334 memset(&event
, 0, sizeof event
);
4335 event
.event
= RDMA_CM_EVENT_DEVICE_REMOVAL
;
4336 ret
= id_priv
->id
.event_handler(&id_priv
->id
, &event
);
4338 mutex_unlock(&id_priv
->handler_mutex
);
4342 static void cma_process_remove(struct cma_device
*cma_dev
)
4344 struct rdma_id_private
*id_priv
;
4348 while (!list_empty(&cma_dev
->id_list
)) {
4349 id_priv
= list_entry(cma_dev
->id_list
.next
,
4350 struct rdma_id_private
, list
);
4352 list_del(&id_priv
->listen_list
);
4353 list_del_init(&id_priv
->list
);
4354 atomic_inc(&id_priv
->refcount
);
4355 mutex_unlock(&lock
);
4357 ret
= id_priv
->internal_id
? 1 : cma_remove_id_dev(id_priv
);
4358 cma_deref_id(id_priv
);
4360 rdma_destroy_id(&id_priv
->id
);
4364 mutex_unlock(&lock
);
4366 cma_deref_dev(cma_dev
);
4367 wait_for_completion(&cma_dev
->comp
);
4370 static void cma_remove_one(struct ib_device
*device
, void *client_data
)
4372 struct cma_device
*cma_dev
= client_data
;
4378 list_del(&cma_dev
->list
);
4379 mutex_unlock(&lock
);
4381 cma_process_remove(cma_dev
);
4382 kfree(cma_dev
->default_roce_tos
);
4383 kfree(cma_dev
->default_gid_type
);
4387 static int cma_get_id_stats(struct sk_buff
*skb
, struct netlink_callback
*cb
)
4389 struct nlmsghdr
*nlh
;
4390 struct rdma_cm_id_stats
*id_stats
;
4391 struct rdma_id_private
*id_priv
;
4392 struct rdma_cm_id
*id
= NULL
;
4393 struct cma_device
*cma_dev
;
4394 int i_dev
= 0, i_id
= 0;
4397 * We export all of the IDs as a sequence of messages. Each
4398 * ID gets its own netlink message.
4402 list_for_each_entry(cma_dev
, &dev_list
, list
) {
4403 if (i_dev
< cb
->args
[0]) {
4409 list_for_each_entry(id_priv
, &cma_dev
->id_list
, list
) {
4410 if (i_id
< cb
->args
[1]) {
4415 id_stats
= ibnl_put_msg(skb
, &nlh
, cb
->nlh
->nlmsg_seq
,
4416 sizeof *id_stats
, RDMA_NL_RDMA_CM
,
4417 RDMA_NL_RDMA_CM_ID_STATS
,
4422 memset(id_stats
, 0, sizeof *id_stats
);
4424 id_stats
->node_type
= id
->route
.addr
.dev_addr
.dev_type
;
4425 id_stats
->port_num
= id
->port_num
;
4426 id_stats
->bound_dev_if
=
4427 id
->route
.addr
.dev_addr
.bound_dev_if
;
4429 if (ibnl_put_attr(skb
, nlh
,
4430 rdma_addr_size(cma_src_addr(id_priv
)),
4431 cma_src_addr(id_priv
),
4432 RDMA_NL_RDMA_CM_ATTR_SRC_ADDR
))
4434 if (ibnl_put_attr(skb
, nlh
,
4435 rdma_addr_size(cma_src_addr(id_priv
)),
4436 cma_dst_addr(id_priv
),
4437 RDMA_NL_RDMA_CM_ATTR_DST_ADDR
))
4440 id_stats
->pid
= id_priv
->owner
;
4441 id_stats
->port_space
= id
->ps
;
4442 id_stats
->cm_state
= id_priv
->state
;
4443 id_stats
->qp_num
= id_priv
->qp_num
;
4444 id_stats
->qp_type
= id
->qp_type
;
4454 mutex_unlock(&lock
);
4455 cb
->args
[0] = i_dev
;
4461 static const struct ibnl_client_cbs cma_cb_table
[] = {
4462 [RDMA_NL_RDMA_CM_ID_STATS
] = { .dump
= cma_get_id_stats
,
4463 .module
= THIS_MODULE
},
4466 static int cma_init_net(struct net
*net
)
4468 struct cma_pernet
*pernet
= cma_pernet(net
);
4470 idr_init(&pernet
->tcp_ps
);
4471 idr_init(&pernet
->udp_ps
);
4472 idr_init(&pernet
->ipoib_ps
);
4473 idr_init(&pernet
->ib_ps
);
4478 static void cma_exit_net(struct net
*net
)
4480 struct cma_pernet
*pernet
= cma_pernet(net
);
4482 idr_destroy(&pernet
->tcp_ps
);
4483 idr_destroy(&pernet
->udp_ps
);
4484 idr_destroy(&pernet
->ipoib_ps
);
4485 idr_destroy(&pernet
->ib_ps
);
4488 static struct pernet_operations cma_pernet_operations
= {
4489 .init
= cma_init_net
,
4490 .exit
= cma_exit_net
,
4491 .id
= &cma_pernet_id
,
4492 .size
= sizeof(struct cma_pernet
),
4495 static int __init
cma_init(void)
4499 cma_wq
= alloc_ordered_workqueue("rdma_cm", WQ_MEM_RECLAIM
);
4503 ret
= register_pernet_subsys(&cma_pernet_operations
);
4507 ib_sa_register_client(&sa_client
);
4508 rdma_addr_register_client(&addr_client
);
4509 register_netdevice_notifier(&cma_nb
);
4511 ret
= ib_register_client(&cma_client
);
4515 if (ibnl_add_client(RDMA_NL_RDMA_CM
, ARRAY_SIZE(cma_cb_table
),
4517 pr_warn("RDMA CMA: failed to add netlink callback\n");
4518 cma_configfs_init();
4523 unregister_netdevice_notifier(&cma_nb
);
4524 rdma_addr_unregister_client(&addr_client
);
4525 ib_sa_unregister_client(&sa_client
);
4527 destroy_workqueue(cma_wq
);
4531 static void __exit
cma_cleanup(void)
4533 cma_configfs_exit();
4534 ibnl_remove_client(RDMA_NL_RDMA_CM
);
4535 ib_unregister_client(&cma_client
);
4536 unregister_netdevice_notifier(&cma_nb
);
4537 rdma_addr_unregister_client(&addr_client
);
4538 ib_sa_unregister_client(&sa_client
);
4539 unregister_pernet_subsys(&cma_pernet_operations
);
4540 destroy_workqueue(cma_wq
);
4543 module_init(cma_init
);
4544 module_exit(cma_cleanup
);