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