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