124f52149SLeon Romanovsky // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB 2e51060f0SSean Hefty /* 3e51060f0SSean Hefty * Copyright (c) 2005 Voltaire Inc. All rights reserved. 4e51060f0SSean Hefty * Copyright (c) 2002-2005, Network Appliance, Inc. All rights reserved. 524f52149SLeon Romanovsky * Copyright (c) 1999-2019, Mellanox Technologies, Inc. All rights reserved. 6e51060f0SSean Hefty * Copyright (c) 2005-2006 Intel Corporation. All rights reserved. 7e51060f0SSean Hefty */ 8e51060f0SSean Hefty 9e51060f0SSean Hefty #include <linux/completion.h> 10e51060f0SSean Hefty #include <linux/in.h> 11e51060f0SSean Hefty #include <linux/in6.h> 12e51060f0SSean Hefty #include <linux/mutex.h> 13e51060f0SSean Hefty #include <linux/random.h> 14bee3c3c9SMoni Shoua #include <linux/igmp.h> 1563826753SMatthew Wilcox #include <linux/xarray.h> 1607ebafbaSTom Tucker #include <linux/inetdevice.h> 175a0e3ad6STejun Heo #include <linux/slab.h> 18e4dd23d7SPaul Gortmaker #include <linux/module.h> 19366cddb4SAmir Vadai #include <net/route.h> 20e51060f0SSean Hefty 214be74b42SHaggai Eran #include <net/net_namespace.h> 224be74b42SHaggai Eran #include <net/netns/generic.h> 23e51060f0SSean Hefty #include <net/tcp.h> 241f5175adSAleksey Senin #include <net/ipv6.h> 25f887f2acSHaggai Eran #include <net/ip_fib.h> 26f887f2acSHaggai Eran #include <net/ip6_route.h> 27e51060f0SSean Hefty 28e51060f0SSean Hefty #include <rdma/rdma_cm.h> 29e51060f0SSean Hefty #include <rdma/rdma_cm_ib.h> 30753f618aSNir Muchtar #include <rdma/rdma_netlink.h> 312e2d190cSSean Hefty #include <rdma/ib.h> 32e51060f0SSean Hefty #include <rdma/ib_cache.h> 33e51060f0SSean Hefty #include <rdma/ib_cm.h> 34e51060f0SSean Hefty #include <rdma/ib_sa.h> 3507ebafbaSTom Tucker #include <rdma/iw_cm.h> 36e51060f0SSean Hefty 37218a773fSMatan Barak #include "core_priv.h" 38a3b641afSSteve Wise #include "cma_priv.h" 39ed999f82SChuck Lever #include "cma_trace.h" 40218a773fSMatan Barak 41e51060f0SSean Hefty MODULE_AUTHOR("Sean Hefty"); 42e51060f0SSean Hefty MODULE_DESCRIPTION("Generic RDMA CM Agent"); 43e51060f0SSean Hefty MODULE_LICENSE("Dual BSD/GPL"); 44e51060f0SSean Hefty 45e51060f0SSean Hefty #define CMA_CM_RESPONSE_TIMEOUT 20 46ab15c95aSAlex Vesker #define CMA_QUERY_CLASSPORT_INFO_TIMEOUT 3000 47d5bb7599SMichael S. Tsirkin #define CMA_MAX_CM_RETRIES 15 48dcb3f974SSean Hefty #define CMA_CM_MRA_SETTING (IB_CM_MRA_FLAG_DELAY | 24) 493c86aa70SEli Cohen #define CMA_IBOE_PACKET_LIFETIME 18 505ab2d89bSLeon Romanovsky #define CMA_PREFERRED_ROCE_GID_TYPE IB_GID_TYPE_ROCE_UDP_ENCAP 51e51060f0SSean Hefty 522b1b5b60SSagi Grimberg static const char * const cma_events[] = { 532b1b5b60SSagi Grimberg [RDMA_CM_EVENT_ADDR_RESOLVED] = "address resolved", 542b1b5b60SSagi Grimberg [RDMA_CM_EVENT_ADDR_ERROR] = "address error", 552b1b5b60SSagi Grimberg [RDMA_CM_EVENT_ROUTE_RESOLVED] = "route resolved ", 562b1b5b60SSagi Grimberg [RDMA_CM_EVENT_ROUTE_ERROR] = "route error", 572b1b5b60SSagi Grimberg [RDMA_CM_EVENT_CONNECT_REQUEST] = "connect request", 582b1b5b60SSagi Grimberg [RDMA_CM_EVENT_CONNECT_RESPONSE] = "connect response", 592b1b5b60SSagi Grimberg [RDMA_CM_EVENT_CONNECT_ERROR] = "connect error", 602b1b5b60SSagi Grimberg [RDMA_CM_EVENT_UNREACHABLE] = "unreachable", 612b1b5b60SSagi Grimberg [RDMA_CM_EVENT_REJECTED] = "rejected", 622b1b5b60SSagi Grimberg [RDMA_CM_EVENT_ESTABLISHED] = "established", 632b1b5b60SSagi Grimberg [RDMA_CM_EVENT_DISCONNECTED] = "disconnected", 642b1b5b60SSagi Grimberg [RDMA_CM_EVENT_DEVICE_REMOVAL] = "device removal", 652b1b5b60SSagi Grimberg [RDMA_CM_EVENT_MULTICAST_JOIN] = "multicast join", 662b1b5b60SSagi Grimberg [RDMA_CM_EVENT_MULTICAST_ERROR] = "multicast error", 672b1b5b60SSagi Grimberg [RDMA_CM_EVENT_ADDR_CHANGE] = "address change", 682b1b5b60SSagi Grimberg [RDMA_CM_EVENT_TIMEWAIT_EXIT] = "timewait exit", 692b1b5b60SSagi Grimberg }; 702b1b5b60SSagi Grimberg 71b5de0c60SJason Gunthorpe static void cma_set_mgid(struct rdma_id_private *id_priv, struct sockaddr *addr, 72b5de0c60SJason Gunthorpe union ib_gid *mgid); 73b5de0c60SJason Gunthorpe 74db7489e0SBart Van Assche const char *__attribute_const__ rdma_event_msg(enum rdma_cm_event_type event) 752b1b5b60SSagi Grimberg { 762b1b5b60SSagi Grimberg size_t index = event; 772b1b5b60SSagi Grimberg 782b1b5b60SSagi Grimberg return (index < ARRAY_SIZE(cma_events) && cma_events[index]) ? 792b1b5b60SSagi Grimberg cma_events[index] : "unrecognized event"; 802b1b5b60SSagi Grimberg } 812b1b5b60SSagi Grimberg EXPORT_SYMBOL(rdma_event_msg); 822b1b5b60SSagi Grimberg 8377a5db13SSteve Wise const char *__attribute_const__ rdma_reject_msg(struct rdma_cm_id *id, 8477a5db13SSteve Wise int reason) 8577a5db13SSteve Wise { 8677a5db13SSteve Wise if (rdma_ib_or_roce(id->device, id->port_num)) 8777a5db13SSteve Wise return ibcm_reject_msg(reason); 8877a5db13SSteve Wise 8977a5db13SSteve Wise if (rdma_protocol_iwarp(id->device, id->port_num)) 9077a5db13SSteve Wise return iwcm_reject_msg(reason); 9177a5db13SSteve Wise 9277a5db13SSteve Wise WARN_ON_ONCE(1); 9377a5db13SSteve Wise return "unrecognized transport"; 9477a5db13SSteve Wise } 9577a5db13SSteve Wise EXPORT_SYMBOL(rdma_reject_msg); 9677a5db13SSteve Wise 97dd302ee4SLeon Romanovsky /** 98dd302ee4SLeon Romanovsky * rdma_is_consumer_reject - return true if the consumer rejected the connect 99dd302ee4SLeon Romanovsky * request. 100dd302ee4SLeon Romanovsky * @id: Communication identifier that received the REJECT event. 101dd302ee4SLeon Romanovsky * @reason: Value returned in the REJECT event status field. 102dd302ee4SLeon Romanovsky */ 103dd302ee4SLeon Romanovsky static bool rdma_is_consumer_reject(struct rdma_cm_id *id, int reason) 1045042a73dSSteve Wise { 1055042a73dSSteve Wise if (rdma_ib_or_roce(id->device, id->port_num)) 1065042a73dSSteve Wise return reason == IB_CM_REJ_CONSUMER_DEFINED; 1075042a73dSSteve Wise 1085042a73dSSteve Wise if (rdma_protocol_iwarp(id->device, id->port_num)) 1095042a73dSSteve Wise return reason == -ECONNREFUSED; 1105042a73dSSteve Wise 1115042a73dSSteve Wise WARN_ON_ONCE(1); 1125042a73dSSteve Wise return false; 1135042a73dSSteve Wise } 1145042a73dSSteve Wise 1155f244104SSteve Wise const void *rdma_consumer_reject_data(struct rdma_cm_id *id, 1165f244104SSteve Wise struct rdma_cm_event *ev, u8 *data_len) 1175f244104SSteve Wise { 1185f244104SSteve Wise const void *p; 1195f244104SSteve Wise 1205f244104SSteve Wise if (rdma_is_consumer_reject(id, ev->status)) { 1215f244104SSteve Wise *data_len = ev->param.conn.private_data_len; 1225f244104SSteve Wise p = ev->param.conn.private_data; 1235f244104SSteve Wise } else { 1245f244104SSteve Wise *data_len = 0; 1255f244104SSteve Wise p = NULL; 1265f244104SSteve Wise } 1275f244104SSteve Wise return p; 1285f244104SSteve Wise } 1295f244104SSteve Wise EXPORT_SYMBOL(rdma_consumer_reject_data); 1305f244104SSteve Wise 131fbdb0a91SSteve Wise /** 132fbdb0a91SSteve Wise * rdma_iw_cm_id() - return the iw_cm_id pointer for this cm_id. 133fbdb0a91SSteve Wise * @id: Communication Identifier 134fbdb0a91SSteve Wise */ 135fbdb0a91SSteve Wise struct iw_cm_id *rdma_iw_cm_id(struct rdma_cm_id *id) 136fbdb0a91SSteve Wise { 137fbdb0a91SSteve Wise struct rdma_id_private *id_priv; 138fbdb0a91SSteve Wise 139fbdb0a91SSteve Wise id_priv = container_of(id, struct rdma_id_private, id); 140fbdb0a91SSteve Wise if (id->device->node_type == RDMA_NODE_RNIC) 141fbdb0a91SSteve Wise return id_priv->cm_id.iw; 142fbdb0a91SSteve Wise return NULL; 143fbdb0a91SSteve Wise } 144fbdb0a91SSteve Wise EXPORT_SYMBOL(rdma_iw_cm_id); 145fbdb0a91SSteve Wise 146fbdb0a91SSteve Wise /** 147fbdb0a91SSteve Wise * rdma_res_to_id() - return the rdma_cm_id pointer for this restrack. 148fbdb0a91SSteve Wise * @res: rdma resource tracking entry pointer 149fbdb0a91SSteve Wise */ 150fbdb0a91SSteve Wise struct rdma_cm_id *rdma_res_to_id(struct rdma_restrack_entry *res) 151fbdb0a91SSteve Wise { 152fbdb0a91SSteve Wise struct rdma_id_private *id_priv = 153fbdb0a91SSteve Wise container_of(res, struct rdma_id_private, res); 154fbdb0a91SSteve Wise 155fbdb0a91SSteve Wise return &id_priv->id; 156fbdb0a91SSteve Wise } 157fbdb0a91SSteve Wise EXPORT_SYMBOL(rdma_res_to_id); 158fbdb0a91SSteve Wise 15911a0ae4cSJason Gunthorpe static int cma_add_one(struct ib_device *device); 1607c1eb45aSHaggai Eran static void cma_remove_one(struct ib_device *device, void *client_data); 161e51060f0SSean Hefty 162e51060f0SSean Hefty static struct ib_client cma_client = { 163e51060f0SSean Hefty .name = "cma", 164e51060f0SSean Hefty .add = cma_add_one, 165e51060f0SSean Hefty .remove = cma_remove_one 166e51060f0SSean Hefty }; 167e51060f0SSean Hefty 168c1a0b23bSMichael S. Tsirkin static struct ib_sa_client sa_client; 169e51060f0SSean Hefty static LIST_HEAD(dev_list); 170e51060f0SSean Hefty static LIST_HEAD(listen_any_list); 171e51060f0SSean Hefty static DEFINE_MUTEX(lock); 172e51060f0SSean Hefty static struct workqueue_struct *cma_wq; 173c7d03a00SAlexey Dobriyan static unsigned int cma_pernet_id; 174e51060f0SSean Hefty 1754be74b42SHaggai Eran struct cma_pernet { 17663826753SMatthew Wilcox struct xarray tcp_ps; 17763826753SMatthew Wilcox struct xarray udp_ps; 17863826753SMatthew Wilcox struct xarray ipoib_ps; 17963826753SMatthew Wilcox struct xarray ib_ps; 1804be74b42SHaggai Eran }; 1814be74b42SHaggai Eran 1824be74b42SHaggai Eran static struct cma_pernet *cma_pernet(struct net *net) 183aac978e1SHaggai Eran { 1844be74b42SHaggai Eran return net_generic(net, cma_pernet_id); 1854be74b42SHaggai Eran } 1864be74b42SHaggai Eran 18763826753SMatthew Wilcox static 18863826753SMatthew Wilcox struct xarray *cma_pernet_xa(struct net *net, enum rdma_ucm_port_space ps) 1894be74b42SHaggai Eran { 1904be74b42SHaggai Eran struct cma_pernet *pernet = cma_pernet(net); 1914be74b42SHaggai Eran 192aac978e1SHaggai Eran switch (ps) { 193aac978e1SHaggai Eran case RDMA_PS_TCP: 1944be74b42SHaggai Eran return &pernet->tcp_ps; 195aac978e1SHaggai Eran case RDMA_PS_UDP: 1964be74b42SHaggai Eran return &pernet->udp_ps; 197aac978e1SHaggai Eran case RDMA_PS_IPOIB: 1984be74b42SHaggai Eran return &pernet->ipoib_ps; 199aac978e1SHaggai Eran case RDMA_PS_IB: 2004be74b42SHaggai Eran return &pernet->ib_ps; 201aac978e1SHaggai Eran default: 202aac978e1SHaggai Eran return NULL; 203aac978e1SHaggai Eran } 204aac978e1SHaggai Eran } 205aac978e1SHaggai Eran 206e51060f0SSean Hefty struct cma_device { 207e51060f0SSean Hefty struct list_head list; 208e51060f0SSean Hefty struct ib_device *device; 209e51060f0SSean Hefty struct completion comp; 210be439912SParav Pandit refcount_t refcount; 211e51060f0SSean Hefty struct list_head id_list; 212045959dbSMatan Barak enum ib_gid_type *default_gid_type; 21389052d78SMajd Dibbiny u8 *default_roce_tos; 214e51060f0SSean Hefty }; 215e51060f0SSean Hefty 216e51060f0SSean Hefty struct rdma_bind_list { 2172253fc0cSSteve Wise enum rdma_ucm_port_space ps; 218e51060f0SSean Hefty struct hlist_head owners; 219e51060f0SSean Hefty unsigned short port; 220e51060f0SSean Hefty }; 221e51060f0SSean Hefty 222ab15c95aSAlex Vesker struct class_port_info_context { 223ab15c95aSAlex Vesker struct ib_class_port_info *class_port_info; 224ab15c95aSAlex Vesker struct ib_device *device; 225ab15c95aSAlex Vesker struct completion done; 226ab15c95aSAlex Vesker struct ib_sa_query *sa_query; 227ab15c95aSAlex Vesker u8 port_num; 228ab15c95aSAlex Vesker }; 229ab15c95aSAlex Vesker 2302253fc0cSSteve Wise static int cma_ps_alloc(struct net *net, enum rdma_ucm_port_space ps, 231aac978e1SHaggai Eran struct rdma_bind_list *bind_list, int snum) 232aac978e1SHaggai Eran { 23363826753SMatthew Wilcox struct xarray *xa = cma_pernet_xa(net, ps); 234aac978e1SHaggai Eran 23563826753SMatthew Wilcox return xa_insert(xa, snum, bind_list, GFP_KERNEL); 236aac978e1SHaggai Eran } 237aac978e1SHaggai Eran 2384be74b42SHaggai Eran static struct rdma_bind_list *cma_ps_find(struct net *net, 2392253fc0cSSteve Wise enum rdma_ucm_port_space ps, int snum) 240aac978e1SHaggai Eran { 24163826753SMatthew Wilcox struct xarray *xa = cma_pernet_xa(net, ps); 242aac978e1SHaggai Eran 24363826753SMatthew Wilcox return xa_load(xa, snum); 244aac978e1SHaggai Eran } 245aac978e1SHaggai Eran 2462253fc0cSSteve Wise static void cma_ps_remove(struct net *net, enum rdma_ucm_port_space ps, 2472253fc0cSSteve Wise int snum) 248aac978e1SHaggai Eran { 24963826753SMatthew Wilcox struct xarray *xa = cma_pernet_xa(net, ps); 250aac978e1SHaggai Eran 25163826753SMatthew Wilcox xa_erase(xa, snum); 252aac978e1SHaggai Eran } 253aac978e1SHaggai Eran 25468602120SSean Hefty enum { 25568602120SSean Hefty CMA_OPTION_AFONLY, 25668602120SSean Hefty }; 25768602120SSean Hefty 2585ff8c8faSParav Pandit void cma_dev_get(struct cma_device *cma_dev) 259218a773fSMatan Barak { 260be439912SParav Pandit refcount_inc(&cma_dev->refcount); 261218a773fSMatan Barak } 262218a773fSMatan Barak 2635ff8c8faSParav Pandit void cma_dev_put(struct cma_device *cma_dev) 2645ff8c8faSParav Pandit { 265be439912SParav Pandit if (refcount_dec_and_test(&cma_dev->refcount)) 2665ff8c8faSParav Pandit complete(&cma_dev->comp); 2675ff8c8faSParav Pandit } 2685ff8c8faSParav Pandit 269045959dbSMatan Barak struct cma_device *cma_enum_devices_by_ibdev(cma_device_filter filter, 270045959dbSMatan Barak void *cookie) 271045959dbSMatan Barak { 272045959dbSMatan Barak struct cma_device *cma_dev; 273045959dbSMatan Barak struct cma_device *found_cma_dev = NULL; 274045959dbSMatan Barak 275045959dbSMatan Barak mutex_lock(&lock); 276045959dbSMatan Barak 277045959dbSMatan Barak list_for_each_entry(cma_dev, &dev_list, list) 278045959dbSMatan Barak if (filter(cma_dev->device, cookie)) { 279045959dbSMatan Barak found_cma_dev = cma_dev; 280045959dbSMatan Barak break; 281045959dbSMatan Barak } 282045959dbSMatan Barak 283045959dbSMatan Barak if (found_cma_dev) 2845ff8c8faSParav Pandit cma_dev_get(found_cma_dev); 285045959dbSMatan Barak mutex_unlock(&lock); 286045959dbSMatan Barak return found_cma_dev; 287045959dbSMatan Barak } 288045959dbSMatan Barak 289045959dbSMatan Barak int cma_get_default_gid_type(struct cma_device *cma_dev, 290045959dbSMatan Barak unsigned int port) 291045959dbSMatan Barak { 29224dc831bSYuval Shaia if (!rdma_is_port_valid(cma_dev->device, port)) 293045959dbSMatan Barak return -EINVAL; 294045959dbSMatan Barak 295045959dbSMatan Barak return cma_dev->default_gid_type[port - rdma_start_port(cma_dev->device)]; 296045959dbSMatan Barak } 297045959dbSMatan Barak 298045959dbSMatan Barak int cma_set_default_gid_type(struct cma_device *cma_dev, 299045959dbSMatan Barak unsigned int port, 300045959dbSMatan Barak enum ib_gid_type default_gid_type) 301045959dbSMatan Barak { 302045959dbSMatan Barak unsigned long supported_gids; 303045959dbSMatan Barak 30424dc831bSYuval Shaia if (!rdma_is_port_valid(cma_dev->device, port)) 305045959dbSMatan Barak return -EINVAL; 306045959dbSMatan Barak 3071c15b4f2SAvihai Horon if (default_gid_type == IB_GID_TYPE_IB && 3081c15b4f2SAvihai Horon rdma_protocol_roce_eth_encap(cma_dev->device, port)) 3091c15b4f2SAvihai Horon default_gid_type = IB_GID_TYPE_ROCE; 3101c15b4f2SAvihai Horon 311045959dbSMatan Barak supported_gids = roce_gid_type_mask_support(cma_dev->device, port); 312045959dbSMatan Barak 313045959dbSMatan Barak if (!(supported_gids & 1 << default_gid_type)) 314045959dbSMatan Barak return -EINVAL; 315045959dbSMatan Barak 316045959dbSMatan Barak cma_dev->default_gid_type[port - rdma_start_port(cma_dev->device)] = 317045959dbSMatan Barak default_gid_type; 318045959dbSMatan Barak 319045959dbSMatan Barak return 0; 320045959dbSMatan Barak } 321045959dbSMatan Barak 32289052d78SMajd Dibbiny int cma_get_default_roce_tos(struct cma_device *cma_dev, unsigned int port) 32389052d78SMajd Dibbiny { 32489052d78SMajd Dibbiny if (!rdma_is_port_valid(cma_dev->device, port)) 32589052d78SMajd Dibbiny return -EINVAL; 32689052d78SMajd Dibbiny 32789052d78SMajd Dibbiny return cma_dev->default_roce_tos[port - rdma_start_port(cma_dev->device)]; 32889052d78SMajd Dibbiny } 32989052d78SMajd Dibbiny 33089052d78SMajd Dibbiny int cma_set_default_roce_tos(struct cma_device *cma_dev, unsigned int port, 33189052d78SMajd Dibbiny u8 default_roce_tos) 33289052d78SMajd Dibbiny { 33389052d78SMajd Dibbiny if (!rdma_is_port_valid(cma_dev->device, port)) 33489052d78SMajd Dibbiny return -EINVAL; 33589052d78SMajd Dibbiny 33689052d78SMajd Dibbiny cma_dev->default_roce_tos[port - rdma_start_port(cma_dev->device)] = 33789052d78SMajd Dibbiny default_roce_tos; 33889052d78SMajd Dibbiny 33989052d78SMajd Dibbiny return 0; 34089052d78SMajd Dibbiny } 341045959dbSMatan Barak struct ib_device *cma_get_ib_dev(struct cma_device *cma_dev) 342045959dbSMatan Barak { 343045959dbSMatan Barak return cma_dev->device; 344045959dbSMatan Barak } 345045959dbSMatan Barak 346e51060f0SSean Hefty /* 347e51060f0SSean Hefty * Device removal can occur at anytime, so we need extra handling to 348e51060f0SSean Hefty * serialize notifying the user of device removal with other callbacks. 349e51060f0SSean Hefty * We do this by disabling removal notification while a callback is in process, 350e51060f0SSean Hefty * and reporting it after the callback completes. 351e51060f0SSean Hefty */ 352e51060f0SSean Hefty 353c8f6a362SSean Hefty struct cma_multicast { 354c8f6a362SSean Hefty struct rdma_id_private *id_priv; 355b5de0c60SJason Gunthorpe struct ib_sa_multicast *sa_mc; 356c8f6a362SSean Hefty struct list_head list; 357c8f6a362SSean Hefty void *context; 3583f446754SRoland Dreier struct sockaddr_storage addr; 359ab15c95aSAlex Vesker u8 join_state; 360c8f6a362SSean Hefty }; 361c8f6a362SSean Hefty 362e51060f0SSean Hefty struct cma_work { 363e51060f0SSean Hefty struct work_struct work; 364e51060f0SSean Hefty struct rdma_id_private *id; 365550e5ca7SNir Muchtar enum rdma_cm_state old_state; 366550e5ca7SNir Muchtar enum rdma_cm_state new_state; 367e51060f0SSean Hefty struct rdma_cm_event event; 368e51060f0SSean Hefty }; 369e51060f0SSean Hefty 370e51060f0SSean Hefty union cma_ip_addr { 371e51060f0SSean Hefty struct in6_addr ip6; 372e51060f0SSean Hefty struct { 3731b90c137SAl Viro __be32 pad[3]; 3741b90c137SAl Viro __be32 addr; 375e51060f0SSean Hefty } ip4; 376e51060f0SSean Hefty }; 377e51060f0SSean Hefty 378e51060f0SSean Hefty struct cma_hdr { 379e51060f0SSean Hefty u8 cma_version; 380e51060f0SSean Hefty u8 ip_version; /* IP version: 7:4 */ 3811b90c137SAl Viro __be16 port; 382e51060f0SSean Hefty union cma_ip_addr src_addr; 383e51060f0SSean Hefty union cma_ip_addr dst_addr; 384e51060f0SSean Hefty }; 385e51060f0SSean Hefty 386e51060f0SSean Hefty #define CMA_VERSION 0x00 387e51060f0SSean Hefty 3884c21b5bcSHaggai Eran struct cma_req_info { 3892918c1a9SParav Pandit struct sockaddr_storage listen_addr_storage; 3902918c1a9SParav Pandit struct sockaddr_storage src_addr_storage; 3914c21b5bcSHaggai Eran struct ib_device *device; 3924c21b5bcSHaggai Eran union ib_gid local_gid; 3934c21b5bcSHaggai Eran __be64 service_id; 39405e0b86cSParav Pandit int port; 39505e0b86cSParav Pandit bool has_gid; 3964c21b5bcSHaggai Eran u16 pkey; 3974c21b5bcSHaggai Eran }; 3984c21b5bcSHaggai Eran 399e51060f0SSean Hefty static int cma_comp_exch(struct rdma_id_private *id_priv, 400550e5ca7SNir Muchtar enum rdma_cm_state comp, enum rdma_cm_state exch) 401e51060f0SSean Hefty { 402e51060f0SSean Hefty unsigned long flags; 403e51060f0SSean Hefty int ret; 404e51060f0SSean Hefty 4052a7cec53SJason Gunthorpe /* 4062a7cec53SJason Gunthorpe * The FSM uses a funny double locking where state is protected by both 4072a7cec53SJason Gunthorpe * the handler_mutex and the spinlock. State is not allowed to change 408071ba4ccSJason Gunthorpe * to/from a handler_mutex protected value without also holding 4092a7cec53SJason Gunthorpe * handler_mutex. 4102a7cec53SJason Gunthorpe */ 411071ba4ccSJason Gunthorpe if (comp == RDMA_CM_CONNECT || exch == RDMA_CM_CONNECT) 4122a7cec53SJason Gunthorpe lockdep_assert_held(&id_priv->handler_mutex); 4132a7cec53SJason Gunthorpe 414e51060f0SSean Hefty spin_lock_irqsave(&id_priv->lock, flags); 415e51060f0SSean Hefty if ((ret = (id_priv->state == comp))) 416e51060f0SSean Hefty id_priv->state = exch; 417e51060f0SSean Hefty spin_unlock_irqrestore(&id_priv->lock, flags); 418e51060f0SSean Hefty return ret; 419e51060f0SSean Hefty } 420e51060f0SSean Hefty 4214c21b5bcSHaggai Eran static inline u8 cma_get_ip_ver(const struct cma_hdr *hdr) 422e51060f0SSean Hefty { 423e51060f0SSean Hefty return hdr->ip_version >> 4; 424e51060f0SSean Hefty } 425e51060f0SSean Hefty 426e51060f0SSean Hefty static inline void cma_set_ip_ver(struct cma_hdr *hdr, u8 ip_ver) 427e51060f0SSean Hefty { 428e51060f0SSean Hefty hdr->ip_version = (ip_ver << 4) | (hdr->ip_version & 0xF); 429e51060f0SSean Hefty } 430e51060f0SSean Hefty 431bee3c3c9SMoni Shoua static int cma_igmp_send(struct net_device *ndev, union ib_gid *mgid, bool join) 432bee3c3c9SMoni Shoua { 433bee3c3c9SMoni Shoua struct in_device *in_dev = NULL; 434bee3c3c9SMoni Shoua 435bee3c3c9SMoni Shoua if (ndev) { 436bee3c3c9SMoni Shoua rtnl_lock(); 437bee3c3c9SMoni Shoua in_dev = __in_dev_get_rtnl(ndev); 438bee3c3c9SMoni Shoua if (in_dev) { 439bee3c3c9SMoni Shoua if (join) 440bee3c3c9SMoni Shoua ip_mc_inc_group(in_dev, 441bee3c3c9SMoni Shoua *(__be32 *)(mgid->raw + 12)); 442bee3c3c9SMoni Shoua else 443bee3c3c9SMoni Shoua ip_mc_dec_group(in_dev, 444bee3c3c9SMoni Shoua *(__be32 *)(mgid->raw + 12)); 445bee3c3c9SMoni Shoua } 446bee3c3c9SMoni Shoua rtnl_unlock(); 447bee3c3c9SMoni Shoua } 448bee3c3c9SMoni Shoua return (in_dev) ? 0 : -ENODEV; 449bee3c3c9SMoni Shoua } 450bee3c3c9SMoni Shoua 451045959dbSMatan Barak static void _cma_attach_to_dev(struct rdma_id_private *id_priv, 452e51060f0SSean Hefty struct cma_device *cma_dev) 453e51060f0SSean Hefty { 4545ff8c8faSParav Pandit cma_dev_get(cma_dev); 455e51060f0SSean Hefty id_priv->cma_dev = cma_dev; 456e51060f0SSean Hefty id_priv->id.device = cma_dev->device; 4573c86aa70SEli Cohen id_priv->id.route.addr.dev_addr.transport = 4583c86aa70SEli Cohen rdma_node_get_transport(cma_dev->device->node_type); 459e51060f0SSean Hefty list_add_tail(&id_priv->list, &cma_dev->id_list); 460c34a23c2SLeon Romanovsky rdma_restrack_add(&id_priv->res); 461b09c4d70SLeon Romanovsky 462278f74b3SChuck Lever trace_cm_id_attach(id_priv, cma_dev->device); 463e51060f0SSean Hefty } 464e51060f0SSean Hefty 465045959dbSMatan Barak static void cma_attach_to_dev(struct rdma_id_private *id_priv, 466045959dbSMatan Barak struct cma_device *cma_dev) 467045959dbSMatan Barak { 468045959dbSMatan Barak _cma_attach_to_dev(id_priv, cma_dev); 469045959dbSMatan Barak id_priv->gid_type = 470045959dbSMatan Barak cma_dev->default_gid_type[id_priv->id.port_num - 471045959dbSMatan Barak rdma_start_port(cma_dev->device)]; 472045959dbSMatan Barak } 473045959dbSMatan Barak 474a396d43aSSean Hefty static void cma_release_dev(struct rdma_id_private *id_priv) 475e51060f0SSean Hefty { 476a396d43aSSean Hefty mutex_lock(&lock); 477e51060f0SSean Hefty list_del(&id_priv->list); 4785ff8c8faSParav Pandit cma_dev_put(id_priv->cma_dev); 479e51060f0SSean Hefty id_priv->cma_dev = NULL; 480*e246b7c0SLeon Romanovsky if (id_priv->id.route.addr.dev_addr.sgid_attr) { 481*e246b7c0SLeon Romanovsky rdma_put_gid_attr(id_priv->id.route.addr.dev_addr.sgid_attr); 482*e246b7c0SLeon Romanovsky id_priv->id.route.addr.dev_addr.sgid_attr = NULL; 483*e246b7c0SLeon Romanovsky } 484a396d43aSSean Hefty mutex_unlock(&lock); 485e51060f0SSean Hefty } 486e51060f0SSean Hefty 487f4753834SSean Hefty static inline struct sockaddr *cma_src_addr(struct rdma_id_private *id_priv) 488f4753834SSean Hefty { 489f4753834SSean Hefty return (struct sockaddr *) &id_priv->id.route.addr.src_addr; 490f4753834SSean Hefty } 491f4753834SSean Hefty 492f4753834SSean Hefty static inline struct sockaddr *cma_dst_addr(struct rdma_id_private *id_priv) 493f4753834SSean Hefty { 494f4753834SSean Hefty return (struct sockaddr *) &id_priv->id.route.addr.dst_addr; 495f4753834SSean Hefty } 496f4753834SSean Hefty 497f4753834SSean Hefty static inline unsigned short cma_family(struct rdma_id_private *id_priv) 498f4753834SSean Hefty { 499f4753834SSean Hefty return id_priv->id.route.addr.src_addr.ss_family; 500f4753834SSean Hefty } 501f4753834SSean Hefty 5025c438135SSean Hefty static int cma_set_qkey(struct rdma_id_private *id_priv, u32 qkey) 503c8f6a362SSean Hefty { 504c8f6a362SSean Hefty struct ib_sa_mcmember_rec rec; 505c8f6a362SSean Hefty int ret = 0; 506c8f6a362SSean Hefty 5075c438135SSean Hefty if (id_priv->qkey) { 5085c438135SSean Hefty if (qkey && id_priv->qkey != qkey) 5095c438135SSean Hefty return -EINVAL; 510d2ca39f2SYossi Etigin return 0; 5115c438135SSean Hefty } 5125c438135SSean Hefty 5135c438135SSean Hefty if (qkey) { 5145c438135SSean Hefty id_priv->qkey = qkey; 5155c438135SSean Hefty return 0; 5165c438135SSean Hefty } 517d2ca39f2SYossi Etigin 518d2ca39f2SYossi Etigin switch (id_priv->id.ps) { 519c8f6a362SSean Hefty case RDMA_PS_UDP: 5205c438135SSean Hefty case RDMA_PS_IB: 521d2ca39f2SYossi Etigin id_priv->qkey = RDMA_UDP_QKEY; 522c8f6a362SSean Hefty break; 523c8f6a362SSean Hefty case RDMA_PS_IPOIB: 524d2ca39f2SYossi Etigin ib_addr_get_mgid(&id_priv->id.route.addr.dev_addr, &rec.mgid); 525d2ca39f2SYossi Etigin ret = ib_sa_get_mcmember_rec(id_priv->id.device, 526d2ca39f2SYossi Etigin id_priv->id.port_num, &rec.mgid, 527d2ca39f2SYossi Etigin &rec); 528d2ca39f2SYossi Etigin if (!ret) 529d2ca39f2SYossi Etigin id_priv->qkey = be32_to_cpu(rec.qkey); 530c8f6a362SSean Hefty break; 531c8f6a362SSean Hefty default: 532c8f6a362SSean Hefty break; 533c8f6a362SSean Hefty } 534c8f6a362SSean Hefty return ret; 535c8f6a362SSean Hefty } 536c8f6a362SSean Hefty 537680f920aSSean Hefty static void cma_translate_ib(struct sockaddr_ib *sib, struct rdma_dev_addr *dev_addr) 538680f920aSSean Hefty { 539680f920aSSean Hefty dev_addr->dev_type = ARPHRD_INFINIBAND; 540680f920aSSean Hefty rdma_addr_set_sgid(dev_addr, (union ib_gid *) &sib->sib_addr); 541680f920aSSean Hefty ib_addr_set_pkey(dev_addr, ntohs(sib->sib_pkey)); 542680f920aSSean Hefty } 543680f920aSSean Hefty 544680f920aSSean Hefty static int cma_translate_addr(struct sockaddr *addr, struct rdma_dev_addr *dev_addr) 545680f920aSSean Hefty { 546680f920aSSean Hefty int ret; 547680f920aSSean Hefty 548680f920aSSean Hefty if (addr->sa_family != AF_IB) { 549575c7e58SParav Pandit ret = rdma_translate_ip(addr, dev_addr); 550680f920aSSean Hefty } else { 551680f920aSSean Hefty cma_translate_ib((struct sockaddr_ib *) addr, dev_addr); 552680f920aSSean Hefty ret = 0; 553680f920aSSean Hefty } 554680f920aSSean Hefty 555680f920aSSean Hefty return ret; 556680f920aSSean Hefty } 557680f920aSSean Hefty 5584ed13a5fSParav Pandit static const struct ib_gid_attr * 5594ed13a5fSParav Pandit cma_validate_port(struct ib_device *device, u8 port, 560045959dbSMatan Barak enum ib_gid_type gid_type, 5612493a57bSParav Pandit union ib_gid *gid, 5622493a57bSParav Pandit struct rdma_id_private *id_priv) 5637c11147dSMichael Wang { 5642493a57bSParav Pandit struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 5652493a57bSParav Pandit int bound_if_index = dev_addr->bound_dev_if; 5664ed13a5fSParav Pandit const struct ib_gid_attr *sgid_attr; 5672493a57bSParav Pandit int dev_type = dev_addr->dev_type; 568abae1b71SMatan Barak struct net_device *ndev = NULL; 5697c11147dSMichael Wang 57041c61401SParav Pandit if (!rdma_dev_access_netns(device, id_priv->id.route.addr.dev_addr.net)) 57141c61401SParav Pandit return ERR_PTR(-ENODEV); 57241c61401SParav Pandit 5737c11147dSMichael Wang if ((dev_type == ARPHRD_INFINIBAND) && !rdma_protocol_ib(device, port)) 5744ed13a5fSParav Pandit return ERR_PTR(-ENODEV); 5757c11147dSMichael Wang 5767c11147dSMichael Wang if ((dev_type != ARPHRD_INFINIBAND) && rdma_protocol_ib(device, port)) 5774ed13a5fSParav Pandit return ERR_PTR(-ENODEV); 5787c11147dSMichael Wang 57900db63c1SParav Pandit if (dev_type == ARPHRD_ETHER && rdma_protocol_roce(device, port)) { 58066c74d74SParav Pandit ndev = dev_get_by_index(dev_addr->net, bound_if_index); 58100db63c1SParav Pandit if (!ndev) 5824ed13a5fSParav Pandit return ERR_PTR(-ENODEV); 58300db63c1SParav Pandit } else { 584045959dbSMatan Barak gid_type = IB_GID_TYPE_IB; 58500db63c1SParav Pandit } 586abae1b71SMatan Barak 5874ed13a5fSParav Pandit sgid_attr = rdma_find_gid_by_port(device, gid, gid_type, port, ndev); 588abae1b71SMatan Barak if (ndev) 589abae1b71SMatan Barak dev_put(ndev); 5904ed13a5fSParav Pandit return sgid_attr; 5914ed13a5fSParav Pandit } 5927c11147dSMichael Wang 5934ed13a5fSParav Pandit static void cma_bind_sgid_attr(struct rdma_id_private *id_priv, 5944ed13a5fSParav Pandit const struct ib_gid_attr *sgid_attr) 5954ed13a5fSParav Pandit { 5964ed13a5fSParav Pandit WARN_ON(id_priv->id.route.addr.dev_addr.sgid_attr); 5974ed13a5fSParav Pandit id_priv->id.route.addr.dev_addr.sgid_attr = sgid_attr; 5987c11147dSMichael Wang } 5997c11147dSMichael Wang 600ff11c6cdSParav Pandit /** 601ff11c6cdSParav Pandit * cma_acquire_dev_by_src_ip - Acquire cma device, port, gid attribute 602ff11c6cdSParav Pandit * based on source ip address. 603ff11c6cdSParav Pandit * @id_priv: cm_id which should be bound to cma device 604ff11c6cdSParav Pandit * 605ff11c6cdSParav Pandit * cma_acquire_dev_by_src_ip() binds cm id to cma device, port and GID attribute 606ff11c6cdSParav Pandit * based on source IP address. It returns 0 on success or error code otherwise. 607ff11c6cdSParav Pandit * It is applicable to active and passive side cm_id. 608ff11c6cdSParav Pandit */ 609ff11c6cdSParav Pandit static int cma_acquire_dev_by_src_ip(struct rdma_id_private *id_priv) 610ff11c6cdSParav Pandit { 611ff11c6cdSParav Pandit struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 612ff11c6cdSParav Pandit const struct ib_gid_attr *sgid_attr; 613ff11c6cdSParav Pandit union ib_gid gid, iboe_gid, *gidp; 614ff11c6cdSParav Pandit struct cma_device *cma_dev; 615ff11c6cdSParav Pandit enum ib_gid_type gid_type; 616ff11c6cdSParav Pandit int ret = -ENODEV; 617ea1075edSJason Gunthorpe unsigned int port; 618ff11c6cdSParav Pandit 619ff11c6cdSParav Pandit if (dev_addr->dev_type != ARPHRD_INFINIBAND && 620ff11c6cdSParav Pandit id_priv->id.ps == RDMA_PS_IPOIB) 621ff11c6cdSParav Pandit return -EINVAL; 622ff11c6cdSParav Pandit 623ff11c6cdSParav Pandit rdma_ip2gid((struct sockaddr *)&id_priv->id.route.addr.src_addr, 624ff11c6cdSParav Pandit &iboe_gid); 625ff11c6cdSParav Pandit 626ff11c6cdSParav Pandit memcpy(&gid, dev_addr->src_dev_addr + 627ff11c6cdSParav Pandit rdma_addr_gid_offset(dev_addr), sizeof(gid)); 628ff11c6cdSParav Pandit 629ff11c6cdSParav Pandit mutex_lock(&lock); 630ff11c6cdSParav Pandit list_for_each_entry(cma_dev, &dev_list, list) { 631ea1075edSJason Gunthorpe rdma_for_each_port (cma_dev->device, port) { 632ff11c6cdSParav Pandit gidp = rdma_protocol_roce(cma_dev->device, port) ? 633ff11c6cdSParav Pandit &iboe_gid : &gid; 634ff11c6cdSParav Pandit gid_type = cma_dev->default_gid_type[port - 1]; 635ff11c6cdSParav Pandit sgid_attr = cma_validate_port(cma_dev->device, port, 636ff11c6cdSParav Pandit gid_type, gidp, id_priv); 637ff11c6cdSParav Pandit if (!IS_ERR(sgid_attr)) { 638ff11c6cdSParav Pandit id_priv->id.port_num = port; 639ff11c6cdSParav Pandit cma_bind_sgid_attr(id_priv, sgid_attr); 640ff11c6cdSParav Pandit cma_attach_to_dev(id_priv, cma_dev); 641ff11c6cdSParav Pandit ret = 0; 642ff11c6cdSParav Pandit goto out; 643ff11c6cdSParav Pandit } 644ff11c6cdSParav Pandit } 645ff11c6cdSParav Pandit } 646ff11c6cdSParav Pandit out: 647ff11c6cdSParav Pandit mutex_unlock(&lock); 648ff11c6cdSParav Pandit return ret; 649ff11c6cdSParav Pandit } 650ff11c6cdSParav Pandit 65141ab1cb7SParav Pandit /** 65241ab1cb7SParav Pandit * cma_ib_acquire_dev - Acquire cma device, port and SGID attribute 65341ab1cb7SParav Pandit * @id_priv: cm id to bind to cma device 65441ab1cb7SParav Pandit * @listen_id_priv: listener cm id to match against 65541ab1cb7SParav Pandit * @req: Pointer to req structure containaining incoming 65641ab1cb7SParav Pandit * request information 65741ab1cb7SParav Pandit * cma_ib_acquire_dev() acquires cma device, port and SGID attribute when 65841ab1cb7SParav Pandit * rdma device matches for listen_id and incoming request. It also verifies 65941ab1cb7SParav Pandit * that a GID table entry is present for the source address. 66041ab1cb7SParav Pandit * Returns 0 on success, or returns error code otherwise. 66141ab1cb7SParav Pandit */ 66241ab1cb7SParav Pandit static int cma_ib_acquire_dev(struct rdma_id_private *id_priv, 66341ab1cb7SParav Pandit const struct rdma_id_private *listen_id_priv, 66441ab1cb7SParav Pandit struct cma_req_info *req) 66541ab1cb7SParav Pandit { 66641ab1cb7SParav Pandit struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 66741ab1cb7SParav Pandit const struct ib_gid_attr *sgid_attr; 66841ab1cb7SParav Pandit enum ib_gid_type gid_type; 66941ab1cb7SParav Pandit union ib_gid gid; 67041ab1cb7SParav Pandit 67141ab1cb7SParav Pandit if (dev_addr->dev_type != ARPHRD_INFINIBAND && 67241ab1cb7SParav Pandit id_priv->id.ps == RDMA_PS_IPOIB) 67341ab1cb7SParav Pandit return -EINVAL; 67441ab1cb7SParav Pandit 67541ab1cb7SParav Pandit if (rdma_protocol_roce(req->device, req->port)) 67641ab1cb7SParav Pandit rdma_ip2gid((struct sockaddr *)&id_priv->id.route.addr.src_addr, 67741ab1cb7SParav Pandit &gid); 67841ab1cb7SParav Pandit else 67941ab1cb7SParav Pandit memcpy(&gid, dev_addr->src_dev_addr + 68041ab1cb7SParav Pandit rdma_addr_gid_offset(dev_addr), sizeof(gid)); 68141ab1cb7SParav Pandit 68241ab1cb7SParav Pandit gid_type = listen_id_priv->cma_dev->default_gid_type[req->port - 1]; 68341ab1cb7SParav Pandit sgid_attr = cma_validate_port(req->device, req->port, 68441ab1cb7SParav Pandit gid_type, &gid, id_priv); 68541ab1cb7SParav Pandit if (IS_ERR(sgid_attr)) 68641ab1cb7SParav Pandit return PTR_ERR(sgid_attr); 68741ab1cb7SParav Pandit 68841ab1cb7SParav Pandit id_priv->id.port_num = req->port; 68941ab1cb7SParav Pandit cma_bind_sgid_attr(id_priv, sgid_attr); 69041ab1cb7SParav Pandit /* Need to acquire lock to protect against reader 69141ab1cb7SParav Pandit * of cma_dev->id_list such as cma_netdev_callback() and 69241ab1cb7SParav Pandit * cma_process_remove(). 69341ab1cb7SParav Pandit */ 69441ab1cb7SParav Pandit mutex_lock(&lock); 69541ab1cb7SParav Pandit cma_attach_to_dev(id_priv, listen_id_priv->cma_dev); 69641ab1cb7SParav Pandit mutex_unlock(&lock); 69741ab1cb7SParav Pandit return 0; 69841ab1cb7SParav Pandit } 69941ab1cb7SParav Pandit 70041ab1cb7SParav Pandit static int cma_iw_acquire_dev(struct rdma_id_private *id_priv, 701e7ff98aeSParav Pandit const struct rdma_id_private *listen_id_priv) 702e51060f0SSean Hefty { 703c8f6a362SSean Hefty struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 7044ed13a5fSParav Pandit const struct ib_gid_attr *sgid_attr; 705e51060f0SSean Hefty struct cma_device *cma_dev; 7064ed13a5fSParav Pandit enum ib_gid_type gid_type; 707e51060f0SSean Hefty int ret = -ENODEV; 708cc055dd3SParav Pandit unsigned int port; 70941ab1cb7SParav Pandit union ib_gid gid; 710e51060f0SSean Hefty 7117c11147dSMichael Wang if (dev_addr->dev_type != ARPHRD_INFINIBAND && 7122efdd6a0SMoni Shoua id_priv->id.ps == RDMA_PS_IPOIB) 7132efdd6a0SMoni Shoua return -EINVAL; 7142efdd6a0SMoni Shoua 7153c86aa70SEli Cohen memcpy(&gid, dev_addr->src_dev_addr + 71641ab1cb7SParav Pandit rdma_addr_gid_offset(dev_addr), sizeof(gid)); 71741ab1cb7SParav Pandit 71841ab1cb7SParav Pandit mutex_lock(&lock); 7197c11147dSMichael Wang 720be9130ccSDoug Ledford cma_dev = listen_id_priv->cma_dev; 721be9130ccSDoug Ledford port = listen_id_priv->id.port_num; 72279d684f0SParav Pandit gid_type = listen_id_priv->gid_type; 7234ed13a5fSParav Pandit sgid_attr = cma_validate_port(cma_dev->device, port, 72441ab1cb7SParav Pandit gid_type, &gid, id_priv); 7254ed13a5fSParav Pandit if (!IS_ERR(sgid_attr)) { 7267c11147dSMichael Wang id_priv->id.port_num = port; 7274ed13a5fSParav Pandit cma_bind_sgid_attr(id_priv, sgid_attr); 7284ed13a5fSParav Pandit ret = 0; 729be9130ccSDoug Ledford goto out; 730be9130ccSDoug Ledford } 7317c11147dSMichael Wang 732e51060f0SSean Hefty list_for_each_entry(cma_dev, &dev_list, list) { 733cc055dd3SParav Pandit rdma_for_each_port (cma_dev->device, port) { 734ff11c6cdSParav Pandit if (listen_id_priv->cma_dev == cma_dev && 735be9130ccSDoug Ledford listen_id_priv->id.port_num == port) 736be9130ccSDoug Ledford continue; 7373c86aa70SEli Cohen 73879d684f0SParav Pandit gid_type = cma_dev->default_gid_type[port - 1]; 7394ed13a5fSParav Pandit sgid_attr = cma_validate_port(cma_dev->device, port, 74041ab1cb7SParav Pandit gid_type, &gid, id_priv); 7414ed13a5fSParav Pandit if (!IS_ERR(sgid_attr)) { 7427c11147dSMichael Wang id_priv->id.port_num = port; 7434ed13a5fSParav Pandit cma_bind_sgid_attr(id_priv, sgid_attr); 7444ed13a5fSParav Pandit ret = 0; 7453c86aa70SEli Cohen goto out; 74663f05be2Sshefty } 747e51060f0SSean Hefty } 748e51060f0SSean Hefty } 7493c86aa70SEli Cohen 7503c86aa70SEli Cohen out: 7513c86aa70SEli Cohen if (!ret) 7523c86aa70SEli Cohen cma_attach_to_dev(id_priv, cma_dev); 7533c86aa70SEli Cohen 754a396d43aSSean Hefty mutex_unlock(&lock); 755e51060f0SSean Hefty return ret; 756e51060f0SSean Hefty } 757e51060f0SSean Hefty 758f17df3b0SSean Hefty /* 759f17df3b0SSean Hefty * Select the source IB device and address to reach the destination IB address. 760f17df3b0SSean Hefty */ 761f17df3b0SSean Hefty static int cma_resolve_ib_dev(struct rdma_id_private *id_priv) 762f17df3b0SSean Hefty { 763f17df3b0SSean Hefty struct cma_device *cma_dev, *cur_dev; 764f17df3b0SSean Hefty struct sockaddr_ib *addr; 765f17df3b0SSean Hefty union ib_gid gid, sgid, *dgid; 766cc055dd3SParav Pandit unsigned int p; 767f17df3b0SSean Hefty u16 pkey, index; 76893b1f29dSJack Wang enum ib_port_state port_state; 769f17df3b0SSean Hefty int i; 770f17df3b0SSean Hefty 771f17df3b0SSean Hefty cma_dev = NULL; 772f17df3b0SSean Hefty addr = (struct sockaddr_ib *) cma_dst_addr(id_priv); 773f17df3b0SSean Hefty dgid = (union ib_gid *) &addr->sib_addr; 774f17df3b0SSean Hefty pkey = ntohs(addr->sib_pkey); 775f17df3b0SSean Hefty 776954a8e3aSParav Pandit mutex_lock(&lock); 777f17df3b0SSean Hefty list_for_each_entry(cur_dev, &dev_list, list) { 778cc055dd3SParav Pandit rdma_for_each_port (cur_dev->device, p) { 77930a74ef4SMichael Wang if (!rdma_cap_af_ib(cur_dev->device, p)) 780f17df3b0SSean Hefty continue; 781f17df3b0SSean Hefty 782f17df3b0SSean Hefty if (ib_find_cached_pkey(cur_dev->device, p, pkey, &index)) 783f17df3b0SSean Hefty continue; 784f17df3b0SSean Hefty 78593b1f29dSJack Wang if (ib_get_cached_port_state(cur_dev->device, p, &port_state)) 78693b1f29dSJack Wang continue; 7871dfce294SParav Pandit for (i = 0; !rdma_query_gid(cur_dev->device, 7881dfce294SParav Pandit p, i, &gid); 78955ee3ab2SMatan Barak i++) { 790f17df3b0SSean Hefty if (!memcmp(&gid, dgid, sizeof(gid))) { 791f17df3b0SSean Hefty cma_dev = cur_dev; 792f17df3b0SSean Hefty sgid = gid; 7938fb488d7SPaul Bolle id_priv->id.port_num = p; 794f17df3b0SSean Hefty goto found; 795f17df3b0SSean Hefty } 796f17df3b0SSean Hefty 797f17df3b0SSean Hefty if (!cma_dev && (gid.global.subnet_prefix == 79893b1f29dSJack Wang dgid->global.subnet_prefix) && 79993b1f29dSJack Wang port_state == IB_PORT_ACTIVE) { 800f17df3b0SSean Hefty cma_dev = cur_dev; 801f17df3b0SSean Hefty sgid = gid; 8028fb488d7SPaul Bolle id_priv->id.port_num = p; 803954a8e3aSParav Pandit goto found; 804f17df3b0SSean Hefty } 805f17df3b0SSean Hefty } 806f17df3b0SSean Hefty } 807f17df3b0SSean Hefty } 808954a8e3aSParav Pandit mutex_unlock(&lock); 809f17df3b0SSean Hefty return -ENODEV; 810f17df3b0SSean Hefty 811f17df3b0SSean Hefty found: 812f17df3b0SSean Hefty cma_attach_to_dev(id_priv, cma_dev); 813954a8e3aSParav Pandit mutex_unlock(&lock); 814f17df3b0SSean Hefty addr = (struct sockaddr_ib *)cma_src_addr(id_priv); 815954a8e3aSParav Pandit memcpy(&addr->sib_addr, &sgid, sizeof(sgid)); 816f17df3b0SSean Hefty cma_translate_ib(addr, &id_priv->id.route.addr.dev_addr); 817f17df3b0SSean Hefty return 0; 818f17df3b0SSean Hefty } 819f17df3b0SSean Hefty 820e368d23fSParav Pandit static void cma_id_get(struct rdma_id_private *id_priv) 821e368d23fSParav Pandit { 82243fb5892SParav Pandit refcount_inc(&id_priv->refcount); 823e368d23fSParav Pandit } 824e368d23fSParav Pandit 825e368d23fSParav Pandit static void cma_id_put(struct rdma_id_private *id_priv) 826e51060f0SSean Hefty { 82743fb5892SParav Pandit if (refcount_dec_and_test(&id_priv->refcount)) 828e51060f0SSean Hefty complete(&id_priv->comp); 829e51060f0SSean Hefty } 830e51060f0SSean Hefty 831b09c4d70SLeon Romanovsky static struct rdma_id_private * 832b09c4d70SLeon Romanovsky __rdma_create_id(struct net *net, rdma_cm_event_handler event_handler, 8332253fc0cSSteve Wise void *context, enum rdma_ucm_port_space ps, 834b09c4d70SLeon Romanovsky enum ib_qp_type qp_type, const struct rdma_id_private *parent) 835e51060f0SSean Hefty { 836e51060f0SSean Hefty struct rdma_id_private *id_priv; 837e51060f0SSean Hefty 838e51060f0SSean Hefty id_priv = kzalloc(sizeof *id_priv, GFP_KERNEL); 839e51060f0SSean Hefty if (!id_priv) 840e51060f0SSean Hefty return ERR_PTR(-ENOMEM); 841e51060f0SSean Hefty 842550e5ca7SNir Muchtar id_priv->state = RDMA_CM_IDLE; 843e51060f0SSean Hefty id_priv->id.context = context; 844e51060f0SSean Hefty id_priv->id.event_handler = event_handler; 845e51060f0SSean Hefty id_priv->id.ps = ps; 846b26f9b99SSean Hefty id_priv->id.qp_type = qp_type; 84789052d78SMajd Dibbiny id_priv->tos_set = false; 8482c1619edSDanit Goldberg id_priv->timeout_set = false; 84979d684f0SParav Pandit id_priv->gid_type = IB_GID_TYPE_IB; 850e51060f0SSean Hefty spin_lock_init(&id_priv->lock); 851c5483388SSean Hefty mutex_init(&id_priv->qp_mutex); 852e51060f0SSean Hefty init_completion(&id_priv->comp); 85343fb5892SParav Pandit refcount_set(&id_priv->refcount, 1); 854de910bd9SOr Gerlitz mutex_init(&id_priv->handler_mutex); 855e51060f0SSean Hefty INIT_LIST_HEAD(&id_priv->listen_list); 856c8f6a362SSean Hefty INIT_LIST_HEAD(&id_priv->mc_list); 857e51060f0SSean Hefty get_random_bytes(&id_priv->seq_num, sizeof id_priv->seq_num); 858fa20105eSGuy Shapiro id_priv->id.route.addr.dev_addr.net = get_net(net); 85923a9cd2aSMoni Shoua id_priv->seq_num &= 0x00ffffff; 860e51060f0SSean Hefty 86113ef5539SLeon Romanovsky rdma_restrack_new(&id_priv->res, RDMA_RESTRACK_CM_ID); 862b09c4d70SLeon Romanovsky if (parent) 863b09c4d70SLeon Romanovsky rdma_restrack_parent_name(&id_priv->res, &parent->res); 86413ef5539SLeon Romanovsky 865b09c4d70SLeon Romanovsky return id_priv; 866e51060f0SSean Hefty } 867b09c4d70SLeon Romanovsky 868b09c4d70SLeon Romanovsky struct rdma_cm_id * 869b09c4d70SLeon Romanovsky __rdma_create_kernel_id(struct net *net, rdma_cm_event_handler event_handler, 870b09c4d70SLeon Romanovsky void *context, enum rdma_ucm_port_space ps, 871b09c4d70SLeon Romanovsky enum ib_qp_type qp_type, const char *caller) 872b09c4d70SLeon Romanovsky { 873b09c4d70SLeon Romanovsky struct rdma_id_private *ret; 874b09c4d70SLeon Romanovsky 875b09c4d70SLeon Romanovsky ret = __rdma_create_id(net, event_handler, context, ps, qp_type, NULL); 876b09c4d70SLeon Romanovsky if (IS_ERR(ret)) 877b09c4d70SLeon Romanovsky return ERR_CAST(ret); 878b09c4d70SLeon Romanovsky 879b09c4d70SLeon Romanovsky rdma_restrack_set_name(&ret->res, caller); 880b09c4d70SLeon Romanovsky return &ret->id; 881b09c4d70SLeon Romanovsky } 882b09c4d70SLeon Romanovsky EXPORT_SYMBOL(__rdma_create_kernel_id); 883b09c4d70SLeon Romanovsky 884b09c4d70SLeon Romanovsky struct rdma_cm_id *rdma_create_user_id(rdma_cm_event_handler event_handler, 885b09c4d70SLeon Romanovsky void *context, 886b09c4d70SLeon Romanovsky enum rdma_ucm_port_space ps, 887b09c4d70SLeon Romanovsky enum ib_qp_type qp_type) 888b09c4d70SLeon Romanovsky { 889b09c4d70SLeon Romanovsky struct rdma_id_private *ret; 890b09c4d70SLeon Romanovsky 891b09c4d70SLeon Romanovsky ret = __rdma_create_id(current->nsproxy->net_ns, event_handler, context, 892b09c4d70SLeon Romanovsky ps, qp_type, NULL); 893b09c4d70SLeon Romanovsky if (IS_ERR(ret)) 894b09c4d70SLeon Romanovsky return ERR_CAST(ret); 895b09c4d70SLeon Romanovsky 896b09c4d70SLeon Romanovsky rdma_restrack_set_name(&ret->res, NULL); 897b09c4d70SLeon Romanovsky return &ret->id; 898b09c4d70SLeon Romanovsky } 899b09c4d70SLeon Romanovsky EXPORT_SYMBOL(rdma_create_user_id); 900e51060f0SSean Hefty 901c8f6a362SSean Hefty static int cma_init_ud_qp(struct rdma_id_private *id_priv, struct ib_qp *qp) 902e51060f0SSean Hefty { 903e51060f0SSean Hefty struct ib_qp_attr qp_attr; 904c8f6a362SSean Hefty int qp_attr_mask, ret; 905e51060f0SSean Hefty 906c8f6a362SSean Hefty qp_attr.qp_state = IB_QPS_INIT; 907c8f6a362SSean Hefty ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask); 908e51060f0SSean Hefty if (ret) 909e51060f0SSean Hefty return ret; 910e51060f0SSean Hefty 911c8f6a362SSean Hefty ret = ib_modify_qp(qp, &qp_attr, qp_attr_mask); 912c8f6a362SSean Hefty if (ret) 913c8f6a362SSean Hefty return ret; 914c8f6a362SSean Hefty 915c8f6a362SSean Hefty qp_attr.qp_state = IB_QPS_RTR; 916c8f6a362SSean Hefty ret = ib_modify_qp(qp, &qp_attr, IB_QP_STATE); 917c8f6a362SSean Hefty if (ret) 918c8f6a362SSean Hefty return ret; 919c8f6a362SSean Hefty 920c8f6a362SSean Hefty qp_attr.qp_state = IB_QPS_RTS; 921c8f6a362SSean Hefty qp_attr.sq_psn = 0; 922c8f6a362SSean Hefty ret = ib_modify_qp(qp, &qp_attr, IB_QP_STATE | IB_QP_SQ_PSN); 923c8f6a362SSean Hefty 924c8f6a362SSean Hefty return ret; 925e51060f0SSean Hefty } 926e51060f0SSean Hefty 927c8f6a362SSean Hefty static int cma_init_conn_qp(struct rdma_id_private *id_priv, struct ib_qp *qp) 92807ebafbaSTom Tucker { 92907ebafbaSTom Tucker struct ib_qp_attr qp_attr; 930c8f6a362SSean Hefty int qp_attr_mask, ret; 93107ebafbaSTom Tucker 93207ebafbaSTom Tucker qp_attr.qp_state = IB_QPS_INIT; 933c8f6a362SSean Hefty ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask); 934c8f6a362SSean Hefty if (ret) 935c8f6a362SSean Hefty return ret; 93607ebafbaSTom Tucker 937c8f6a362SSean Hefty return ib_modify_qp(qp, &qp_attr, qp_attr_mask); 93807ebafbaSTom Tucker } 93907ebafbaSTom Tucker 940e51060f0SSean Hefty int rdma_create_qp(struct rdma_cm_id *id, struct ib_pd *pd, 941e51060f0SSean Hefty struct ib_qp_init_attr *qp_init_attr) 942e51060f0SSean Hefty { 943e51060f0SSean Hefty struct rdma_id_private *id_priv; 944e51060f0SSean Hefty struct ib_qp *qp; 945e51060f0SSean Hefty int ret; 946e51060f0SSean Hefty 947e51060f0SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 948ed999f82SChuck Lever if (id->device != pd->device) { 949ed999f82SChuck Lever ret = -EINVAL; 950ed999f82SChuck Lever goto out_err; 951ed999f82SChuck Lever } 952e51060f0SSean Hefty 9530691a286SChristoph Hellwig qp_init_attr->port_num = id->port_num; 954e51060f0SSean Hefty qp = ib_create_qp(pd, qp_init_attr); 955ed999f82SChuck Lever if (IS_ERR(qp)) { 956ed999f82SChuck Lever ret = PTR_ERR(qp); 957ed999f82SChuck Lever goto out_err; 958ed999f82SChuck Lever } 959e51060f0SSean Hefty 960b26f9b99SSean Hefty if (id->qp_type == IB_QPT_UD) 961c8f6a362SSean Hefty ret = cma_init_ud_qp(id_priv, qp); 962c8f6a362SSean Hefty else 963c8f6a362SSean Hefty ret = cma_init_conn_qp(id_priv, qp); 964e51060f0SSean Hefty if (ret) 965ed999f82SChuck Lever goto out_destroy; 966e51060f0SSean Hefty 967e51060f0SSean Hefty id->qp = qp; 968e51060f0SSean Hefty id_priv->qp_num = qp->qp_num; 969e51060f0SSean Hefty id_priv->srq = (qp->srq != NULL); 970ed999f82SChuck Lever trace_cm_qp_create(id_priv, pd, qp_init_attr, 0); 971e51060f0SSean Hefty return 0; 972ed999f82SChuck Lever out_destroy: 973e51060f0SSean Hefty ib_destroy_qp(qp); 974ed999f82SChuck Lever out_err: 975ed999f82SChuck Lever trace_cm_qp_create(id_priv, pd, qp_init_attr, ret); 976e51060f0SSean Hefty return ret; 977e51060f0SSean Hefty } 978e51060f0SSean Hefty EXPORT_SYMBOL(rdma_create_qp); 979e51060f0SSean Hefty 980e51060f0SSean Hefty void rdma_destroy_qp(struct rdma_cm_id *id) 981e51060f0SSean Hefty { 982c5483388SSean Hefty struct rdma_id_private *id_priv; 983c5483388SSean Hefty 984c5483388SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 985ed999f82SChuck Lever trace_cm_qp_destroy(id_priv); 986c5483388SSean Hefty mutex_lock(&id_priv->qp_mutex); 987c5483388SSean Hefty ib_destroy_qp(id_priv->id.qp); 988c5483388SSean Hefty id_priv->id.qp = NULL; 989c5483388SSean Hefty mutex_unlock(&id_priv->qp_mutex); 990e51060f0SSean Hefty } 991e51060f0SSean Hefty EXPORT_SYMBOL(rdma_destroy_qp); 992e51060f0SSean Hefty 9935851bb89SSean Hefty static int cma_modify_qp_rtr(struct rdma_id_private *id_priv, 9945851bb89SSean Hefty struct rdma_conn_param *conn_param) 995e51060f0SSean Hefty { 996e51060f0SSean Hefty struct ib_qp_attr qp_attr; 997e51060f0SSean Hefty int qp_attr_mask, ret; 998e51060f0SSean Hefty 999c5483388SSean Hefty mutex_lock(&id_priv->qp_mutex); 1000c5483388SSean Hefty if (!id_priv->id.qp) { 1001c5483388SSean Hefty ret = 0; 1002c5483388SSean Hefty goto out; 1003c5483388SSean Hefty } 1004e51060f0SSean Hefty 1005e51060f0SSean Hefty /* Need to update QP attributes from default values. */ 1006e51060f0SSean Hefty qp_attr.qp_state = IB_QPS_INIT; 1007c5483388SSean Hefty ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask); 1008e51060f0SSean Hefty if (ret) 1009c5483388SSean Hefty goto out; 1010e51060f0SSean Hefty 1011c5483388SSean Hefty ret = ib_modify_qp(id_priv->id.qp, &qp_attr, qp_attr_mask); 1012e51060f0SSean Hefty if (ret) 1013c5483388SSean Hefty goto out; 1014e51060f0SSean Hefty 1015e51060f0SSean Hefty qp_attr.qp_state = IB_QPS_RTR; 1016c5483388SSean Hefty ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask); 1017e51060f0SSean Hefty if (ret) 1018c5483388SSean Hefty goto out; 1019e51060f0SSean Hefty 1020fef60902SMichael Wang BUG_ON(id_priv->cma_dev->device != id_priv->id.device); 1021fef60902SMichael Wang 10225851bb89SSean Hefty if (conn_param) 10235851bb89SSean Hefty qp_attr.max_dest_rd_atomic = conn_param->responder_resources; 1024c5483388SSean Hefty ret = ib_modify_qp(id_priv->id.qp, &qp_attr, qp_attr_mask); 1025c5483388SSean Hefty out: 1026c5483388SSean Hefty mutex_unlock(&id_priv->qp_mutex); 1027c5483388SSean Hefty return ret; 1028e51060f0SSean Hefty } 1029e51060f0SSean Hefty 10305851bb89SSean Hefty static int cma_modify_qp_rts(struct rdma_id_private *id_priv, 10315851bb89SSean Hefty struct rdma_conn_param *conn_param) 1032e51060f0SSean Hefty { 1033e51060f0SSean Hefty struct ib_qp_attr qp_attr; 1034e51060f0SSean Hefty int qp_attr_mask, ret; 1035e51060f0SSean Hefty 1036c5483388SSean Hefty mutex_lock(&id_priv->qp_mutex); 1037c5483388SSean Hefty if (!id_priv->id.qp) { 1038c5483388SSean Hefty ret = 0; 1039c5483388SSean Hefty goto out; 1040e51060f0SSean Hefty } 1041e51060f0SSean Hefty 1042c5483388SSean Hefty qp_attr.qp_state = IB_QPS_RTS; 1043c5483388SSean Hefty ret = rdma_init_qp_attr(&id_priv->id, &qp_attr, &qp_attr_mask); 1044c5483388SSean Hefty if (ret) 1045c5483388SSean Hefty goto out; 1046c5483388SSean Hefty 10475851bb89SSean Hefty if (conn_param) 10485851bb89SSean Hefty qp_attr.max_rd_atomic = conn_param->initiator_depth; 1049c5483388SSean Hefty ret = ib_modify_qp(id_priv->id.qp, &qp_attr, qp_attr_mask); 1050c5483388SSean Hefty out: 1051c5483388SSean Hefty mutex_unlock(&id_priv->qp_mutex); 1052c5483388SSean Hefty return ret; 1053c5483388SSean Hefty } 1054c5483388SSean Hefty 1055c5483388SSean Hefty static int cma_modify_qp_err(struct rdma_id_private *id_priv) 1056e51060f0SSean Hefty { 1057e51060f0SSean Hefty struct ib_qp_attr qp_attr; 1058c5483388SSean Hefty int ret; 1059e51060f0SSean Hefty 1060c5483388SSean Hefty mutex_lock(&id_priv->qp_mutex); 1061c5483388SSean Hefty if (!id_priv->id.qp) { 1062c5483388SSean Hefty ret = 0; 1063c5483388SSean Hefty goto out; 1064c5483388SSean Hefty } 1065e51060f0SSean Hefty 1066e51060f0SSean Hefty qp_attr.qp_state = IB_QPS_ERR; 1067c5483388SSean Hefty ret = ib_modify_qp(id_priv->id.qp, &qp_attr, IB_QP_STATE); 1068c5483388SSean Hefty out: 1069c5483388SSean Hefty mutex_unlock(&id_priv->qp_mutex); 1070c5483388SSean Hefty return ret; 1071e51060f0SSean Hefty } 1072e51060f0SSean Hefty 1073c8f6a362SSean Hefty static int cma_ib_init_qp_attr(struct rdma_id_private *id_priv, 1074c8f6a362SSean Hefty struct ib_qp_attr *qp_attr, int *qp_attr_mask) 1075c8f6a362SSean Hefty { 1076c8f6a362SSean Hefty struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 1077c8f6a362SSean Hefty int ret; 10783c86aa70SEli Cohen u16 pkey; 10793c86aa70SEli Cohen 1080227128fcSMichael Wang if (rdma_cap_eth_ah(id_priv->id.device, id_priv->id.port_num)) 10813c86aa70SEli Cohen pkey = 0xffff; 1082fef60902SMichael Wang else 1083fef60902SMichael Wang pkey = ib_addr_get_pkey(dev_addr); 1084c8f6a362SSean Hefty 1085c8f6a362SSean Hefty ret = ib_find_cached_pkey(id_priv->id.device, id_priv->id.port_num, 10863c86aa70SEli Cohen pkey, &qp_attr->pkey_index); 1087c8f6a362SSean Hefty if (ret) 1088c8f6a362SSean Hefty return ret; 1089c8f6a362SSean Hefty 1090c8f6a362SSean Hefty qp_attr->port_num = id_priv->id.port_num; 1091c8f6a362SSean Hefty *qp_attr_mask = IB_QP_STATE | IB_QP_PKEY_INDEX | IB_QP_PORT; 1092c8f6a362SSean Hefty 1093b26f9b99SSean Hefty if (id_priv->id.qp_type == IB_QPT_UD) { 10945c438135SSean Hefty ret = cma_set_qkey(id_priv, 0); 1095d2ca39f2SYossi Etigin if (ret) 1096d2ca39f2SYossi Etigin return ret; 1097d2ca39f2SYossi Etigin 1098c8f6a362SSean Hefty qp_attr->qkey = id_priv->qkey; 1099c8f6a362SSean Hefty *qp_attr_mask |= IB_QP_QKEY; 1100c8f6a362SSean Hefty } else { 1101c8f6a362SSean Hefty qp_attr->qp_access_flags = 0; 1102c8f6a362SSean Hefty *qp_attr_mask |= IB_QP_ACCESS_FLAGS; 1103c8f6a362SSean Hefty } 1104c8f6a362SSean Hefty return 0; 1105c8f6a362SSean Hefty } 1106c8f6a362SSean Hefty 1107e51060f0SSean Hefty int rdma_init_qp_attr(struct rdma_cm_id *id, struct ib_qp_attr *qp_attr, 1108e51060f0SSean Hefty int *qp_attr_mask) 1109e51060f0SSean Hefty { 1110e51060f0SSean Hefty struct rdma_id_private *id_priv; 1111c8f6a362SSean Hefty int ret = 0; 1112e51060f0SSean Hefty 1113e51060f0SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 111472219ceaSMichael Wang if (rdma_cap_ib_cm(id->device, id->port_num)) { 1115b26f9b99SSean Hefty if (!id_priv->cm_id.ib || (id_priv->id.qp_type == IB_QPT_UD)) 1116c8f6a362SSean Hefty ret = cma_ib_init_qp_attr(id_priv, qp_attr, qp_attr_mask); 1117c8f6a362SSean Hefty else 1118e51060f0SSean Hefty ret = ib_cm_init_qp_attr(id_priv->cm_id.ib, qp_attr, 1119e51060f0SSean Hefty qp_attr_mask); 1120dd5f03beSMatan Barak 1121e51060f0SSean Hefty if (qp_attr->qp_state == IB_QPS_RTR) 1122e51060f0SSean Hefty qp_attr->rq_psn = id_priv->seq_num; 112304215330SMichael Wang } else if (rdma_cap_iw_cm(id->device, id->port_num)) { 1124c8f6a362SSean Hefty if (!id_priv->cm_id.iw) { 11258f076531SDotan Barak qp_attr->qp_access_flags = 0; 1126c8f6a362SSean Hefty *qp_attr_mask = IB_QP_STATE | IB_QP_ACCESS_FLAGS; 1127c8f6a362SSean Hefty } else 112807ebafbaSTom Tucker ret = iw_cm_init_qp_attr(id_priv->cm_id.iw, qp_attr, 112907ebafbaSTom Tucker qp_attr_mask); 1130a62ab66bSIsmail, Mustafa qp_attr->port_num = id_priv->id.port_num; 1131a62ab66bSIsmail, Mustafa *qp_attr_mask |= IB_QP_PORT; 113221655afcSMichael Wang } else 1133e51060f0SSean Hefty ret = -ENOSYS; 1134e51060f0SSean Hefty 11352c1619edSDanit Goldberg if ((*qp_attr_mask & IB_QP_TIMEOUT) && id_priv->timeout_set) 11362c1619edSDanit Goldberg qp_attr->timeout = id_priv->timeout; 11372c1619edSDanit Goldberg 1138e51060f0SSean Hefty return ret; 1139e51060f0SSean Hefty } 1140e51060f0SSean Hefty EXPORT_SYMBOL(rdma_init_qp_attr); 1141e51060f0SSean Hefty 1142ca3a8aceSParav Pandit static inline bool cma_zero_addr(const struct sockaddr *addr) 1143e51060f0SSean Hefty { 11442e2d190cSSean Hefty switch (addr->sa_family) { 11452e2d190cSSean Hefty case AF_INET: 11462e2d190cSSean Hefty return ipv4_is_zeronet(((struct sockaddr_in *)addr)->sin_addr.s_addr); 11472e2d190cSSean Hefty case AF_INET6: 11482e2d190cSSean Hefty return ipv6_addr_any(&((struct sockaddr_in6 *)addr)->sin6_addr); 11492e2d190cSSean Hefty case AF_IB: 11502e2d190cSSean Hefty return ib_addr_any(&((struct sockaddr_ib *)addr)->sib_addr); 11512e2d190cSSean Hefty default: 1152ca3a8aceSParav Pandit return false; 1153e51060f0SSean Hefty } 1154e51060f0SSean Hefty } 1155e51060f0SSean Hefty 1156ca3a8aceSParav Pandit static inline bool cma_loopback_addr(const struct sockaddr *addr) 1157e51060f0SSean Hefty { 11582e2d190cSSean Hefty switch (addr->sa_family) { 11592e2d190cSSean Hefty case AF_INET: 1160ca3a8aceSParav Pandit return ipv4_is_loopback( 1161ca3a8aceSParav Pandit ((struct sockaddr_in *)addr)->sin_addr.s_addr); 11622e2d190cSSean Hefty case AF_INET6: 1163ca3a8aceSParav Pandit return ipv6_addr_loopback( 1164ca3a8aceSParav Pandit &((struct sockaddr_in6 *)addr)->sin6_addr); 11652e2d190cSSean Hefty case AF_IB: 1166ca3a8aceSParav Pandit return ib_addr_loopback( 1167ca3a8aceSParav Pandit &((struct sockaddr_ib *)addr)->sib_addr); 11682e2d190cSSean Hefty default: 1169ca3a8aceSParav Pandit return false; 11702e2d190cSSean Hefty } 1171e51060f0SSean Hefty } 1172e51060f0SSean Hefty 1173ca3a8aceSParav Pandit static inline bool cma_any_addr(const struct sockaddr *addr) 1174e51060f0SSean Hefty { 1175e51060f0SSean Hefty return cma_zero_addr(addr) || cma_loopback_addr(addr); 1176e51060f0SSean Hefty } 1177e51060f0SSean Hefty 11785d7ed2f2SParav Pandit static int cma_addr_cmp(const struct sockaddr *src, const struct sockaddr *dst) 117943b752daSHefty, Sean { 118043b752daSHefty, Sean if (src->sa_family != dst->sa_family) 118143b752daSHefty, Sean return -1; 118243b752daSHefty, Sean 118343b752daSHefty, Sean switch (src->sa_family) { 118443b752daSHefty, Sean case AF_INET: 118543b752daSHefty, Sean return ((struct sockaddr_in *)src)->sin_addr.s_addr != 118643b752daSHefty, Sean ((struct sockaddr_in *)dst)->sin_addr.s_addr; 11875d7ed2f2SParav Pandit case AF_INET6: { 11885d7ed2f2SParav Pandit struct sockaddr_in6 *src_addr6 = (struct sockaddr_in6 *)src; 11895d7ed2f2SParav Pandit struct sockaddr_in6 *dst_addr6 = (struct sockaddr_in6 *)dst; 11905d7ed2f2SParav Pandit bool link_local; 11915d7ed2f2SParav Pandit 11925d7ed2f2SParav Pandit if (ipv6_addr_cmp(&src_addr6->sin6_addr, 11935d7ed2f2SParav Pandit &dst_addr6->sin6_addr)) 11945d7ed2f2SParav Pandit return 1; 11955d7ed2f2SParav Pandit link_local = ipv6_addr_type(&dst_addr6->sin6_addr) & 11965d7ed2f2SParav Pandit IPV6_ADDR_LINKLOCAL; 11975d7ed2f2SParav Pandit /* Link local must match their scope_ids */ 11985d7ed2f2SParav Pandit return link_local ? (src_addr6->sin6_scope_id != 11995d7ed2f2SParav Pandit dst_addr6->sin6_scope_id) : 12005d7ed2f2SParav Pandit 0; 12015d7ed2f2SParav Pandit } 12025d7ed2f2SParav Pandit 12032e2d190cSSean Hefty default: 12042e2d190cSSean Hefty return ib_addr_cmp(&((struct sockaddr_ib *) src)->sib_addr, 12052e2d190cSSean Hefty &((struct sockaddr_ib *) dst)->sib_addr); 120643b752daSHefty, Sean } 120743b752daSHefty, Sean } 120843b752daSHefty, Sean 12092df7dba8SParav Pandit static __be16 cma_port(const struct sockaddr *addr) 1210628e5f6dSSean Hefty { 121158afdcb7SSean Hefty struct sockaddr_ib *sib; 121258afdcb7SSean Hefty 121358afdcb7SSean Hefty switch (addr->sa_family) { 121458afdcb7SSean Hefty case AF_INET: 1215628e5f6dSSean Hefty return ((struct sockaddr_in *) addr)->sin_port; 121658afdcb7SSean Hefty case AF_INET6: 1217628e5f6dSSean Hefty return ((struct sockaddr_in6 *) addr)->sin6_port; 121858afdcb7SSean Hefty case AF_IB: 121958afdcb7SSean Hefty sib = (struct sockaddr_ib *) addr; 122058afdcb7SSean Hefty return htons((u16) (be64_to_cpu(sib->sib_sid) & 122158afdcb7SSean Hefty be64_to_cpu(sib->sib_sid_mask))); 122258afdcb7SSean Hefty default: 122358afdcb7SSean Hefty return 0; 122458afdcb7SSean Hefty } 1225628e5f6dSSean Hefty } 1226628e5f6dSSean Hefty 12272df7dba8SParav Pandit static inline int cma_any_port(const struct sockaddr *addr) 1228e51060f0SSean Hefty { 1229628e5f6dSSean Hefty return !cma_port(addr); 1230e51060f0SSean Hefty } 1231e51060f0SSean Hefty 12320c505f70SHaggai Eran static void cma_save_ib_info(struct sockaddr *src_addr, 12330c505f70SHaggai Eran struct sockaddr *dst_addr, 1234e7ff98aeSParav Pandit const struct rdma_cm_id *listen_id, 1235e7ff98aeSParav Pandit const struct sa_path_rec *path) 1236e51060f0SSean Hefty { 1237fbaa1a6dSSean Hefty struct sockaddr_ib *listen_ib, *ib; 1238e51060f0SSean Hefty 1239fbaa1a6dSSean Hefty listen_ib = (struct sockaddr_ib *) &listen_id->route.addr.src_addr; 12400c505f70SHaggai Eran if (src_addr) { 12410c505f70SHaggai Eran ib = (struct sockaddr_ib *)src_addr; 12420c505f70SHaggai Eran ib->sib_family = AF_IB; 1243c07678bbSMatthew Finlay if (path) { 1244fbaa1a6dSSean Hefty ib->sib_pkey = path->pkey; 1245fbaa1a6dSSean Hefty ib->sib_flowinfo = path->flow_label; 1246fbaa1a6dSSean Hefty memcpy(&ib->sib_addr, &path->sgid, 16); 1247d3957b86SMajd Dibbiny ib->sib_sid = path->service_id; 12480c505f70SHaggai Eran ib->sib_scope_id = 0; 1249c07678bbSMatthew Finlay } else { 1250c07678bbSMatthew Finlay ib->sib_pkey = listen_ib->sib_pkey; 1251c07678bbSMatthew Finlay ib->sib_flowinfo = listen_ib->sib_flowinfo; 1252c07678bbSMatthew Finlay ib->sib_addr = listen_ib->sib_addr; 1253fbaa1a6dSSean Hefty ib->sib_sid = listen_ib->sib_sid; 1254fbaa1a6dSSean Hefty ib->sib_scope_id = listen_ib->sib_scope_id; 12550c505f70SHaggai Eran } 12560c505f70SHaggai Eran ib->sib_sid_mask = cpu_to_be64(0xffffffffffffffffULL); 12570c505f70SHaggai Eran } 12580c505f70SHaggai Eran if (dst_addr) { 12590c505f70SHaggai Eran ib = (struct sockaddr_ib *)dst_addr; 12600c505f70SHaggai Eran ib->sib_family = AF_IB; 1261c07678bbSMatthew Finlay if (path) { 1262fbaa1a6dSSean Hefty ib->sib_pkey = path->pkey; 1263fbaa1a6dSSean Hefty ib->sib_flowinfo = path->flow_label; 1264fbaa1a6dSSean Hefty memcpy(&ib->sib_addr, &path->dgid, 16); 1265fbaa1a6dSSean Hefty } 1266c07678bbSMatthew Finlay } 126728521440SJason Gunthorpe } 126828521440SJason Gunthorpe 1269c50e90d0SArnd Bergmann static void cma_save_ip4_info(struct sockaddr_in *src_addr, 1270c50e90d0SArnd Bergmann struct sockaddr_in *dst_addr, 12710c505f70SHaggai Eran struct cma_hdr *hdr, 12720c505f70SHaggai Eran __be16 local_port) 1273fbaa1a6dSSean Hefty { 12740c505f70SHaggai Eran if (src_addr) { 1275c50e90d0SArnd Bergmann *src_addr = (struct sockaddr_in) { 1276c50e90d0SArnd Bergmann .sin_family = AF_INET, 1277c50e90d0SArnd Bergmann .sin_addr.s_addr = hdr->dst_addr.ip4.addr, 1278c50e90d0SArnd Bergmann .sin_port = local_port, 1279c50e90d0SArnd Bergmann }; 12800c505f70SHaggai Eran } 1281fbaa1a6dSSean Hefty 12820c505f70SHaggai Eran if (dst_addr) { 1283c50e90d0SArnd Bergmann *dst_addr = (struct sockaddr_in) { 1284c50e90d0SArnd Bergmann .sin_family = AF_INET, 1285c50e90d0SArnd Bergmann .sin_addr.s_addr = hdr->src_addr.ip4.addr, 1286c50e90d0SArnd Bergmann .sin_port = hdr->port, 1287c50e90d0SArnd Bergmann }; 1288fbaa1a6dSSean Hefty } 12890c505f70SHaggai Eran } 1290fbaa1a6dSSean Hefty 1291c50e90d0SArnd Bergmann static void cma_save_ip6_info(struct sockaddr_in6 *src_addr, 1292c50e90d0SArnd Bergmann struct sockaddr_in6 *dst_addr, 12930c505f70SHaggai Eran struct cma_hdr *hdr, 12940c505f70SHaggai Eran __be16 local_port) 1295fbaa1a6dSSean Hefty { 12960c505f70SHaggai Eran if (src_addr) { 1297c50e90d0SArnd Bergmann *src_addr = (struct sockaddr_in6) { 1298c50e90d0SArnd Bergmann .sin6_family = AF_INET6, 1299c50e90d0SArnd Bergmann .sin6_addr = hdr->dst_addr.ip6, 1300c50e90d0SArnd Bergmann .sin6_port = local_port, 1301c50e90d0SArnd Bergmann }; 13020c505f70SHaggai Eran } 1303fbaa1a6dSSean Hefty 13040c505f70SHaggai Eran if (dst_addr) { 1305c50e90d0SArnd Bergmann *dst_addr = (struct sockaddr_in6) { 1306c50e90d0SArnd Bergmann .sin6_family = AF_INET6, 1307c50e90d0SArnd Bergmann .sin6_addr = hdr->src_addr.ip6, 1308c50e90d0SArnd Bergmann .sin6_port = hdr->port, 1309c50e90d0SArnd Bergmann }; 1310fbaa1a6dSSean Hefty } 13110c505f70SHaggai Eran } 1312fbaa1a6dSSean Hefty 13130c505f70SHaggai Eran static u16 cma_port_from_service_id(__be64 service_id) 13140c505f70SHaggai Eran { 13150c505f70SHaggai Eran return (u16)be64_to_cpu(service_id); 13160c505f70SHaggai Eran } 13170c505f70SHaggai Eran 13180c505f70SHaggai Eran static int cma_save_ip_info(struct sockaddr *src_addr, 13190c505f70SHaggai Eran struct sockaddr *dst_addr, 1320e7ff98aeSParav Pandit const struct ib_cm_event *ib_event, 13210c505f70SHaggai Eran __be64 service_id) 1322fbaa1a6dSSean Hefty { 1323fbaa1a6dSSean Hefty struct cma_hdr *hdr; 13240c505f70SHaggai Eran __be16 port; 1325e51060f0SSean Hefty 1326fbaa1a6dSSean Hefty hdr = ib_event->private_data; 1327fbaa1a6dSSean Hefty if (hdr->cma_version != CMA_VERSION) 1328fbaa1a6dSSean Hefty return -EINVAL; 1329e51060f0SSean Hefty 13300c505f70SHaggai Eran port = htons(cma_port_from_service_id(service_id)); 13310c505f70SHaggai Eran 1332fbaa1a6dSSean Hefty switch (cma_get_ip_ver(hdr)) { 1333e51060f0SSean Hefty case 4: 1334c50e90d0SArnd Bergmann cma_save_ip4_info((struct sockaddr_in *)src_addr, 1335c50e90d0SArnd Bergmann (struct sockaddr_in *)dst_addr, hdr, port); 1336e51060f0SSean Hefty break; 1337e51060f0SSean Hefty case 6: 1338c50e90d0SArnd Bergmann cma_save_ip6_info((struct sockaddr_in6 *)src_addr, 1339c50e90d0SArnd Bergmann (struct sockaddr_in6 *)dst_addr, hdr, port); 1340e51060f0SSean Hefty break; 1341e51060f0SSean Hefty default: 13424c21b5bcSHaggai Eran return -EAFNOSUPPORT; 1343e51060f0SSean Hefty } 13440c505f70SHaggai Eran 1345fbaa1a6dSSean Hefty return 0; 1346e51060f0SSean Hefty } 1347e51060f0SSean Hefty 13480c505f70SHaggai Eran static int cma_save_net_info(struct sockaddr *src_addr, 13490c505f70SHaggai Eran struct sockaddr *dst_addr, 1350e7ff98aeSParav Pandit const struct rdma_cm_id *listen_id, 1351e7ff98aeSParav Pandit const struct ib_cm_event *ib_event, 13520c505f70SHaggai Eran sa_family_t sa_family, __be64 service_id) 13530c505f70SHaggai Eran { 13540c505f70SHaggai Eran if (sa_family == AF_IB) { 13550c505f70SHaggai Eran if (ib_event->event == IB_CM_REQ_RECEIVED) 13560c505f70SHaggai Eran cma_save_ib_info(src_addr, dst_addr, listen_id, 13570c505f70SHaggai Eran ib_event->param.req_rcvd.primary_path); 13580c505f70SHaggai Eran else if (ib_event->event == IB_CM_SIDR_REQ_RECEIVED) 13590c505f70SHaggai Eran cma_save_ib_info(src_addr, dst_addr, listen_id, NULL); 13600c505f70SHaggai Eran return 0; 13610c505f70SHaggai Eran } 13620c505f70SHaggai Eran 13630c505f70SHaggai Eran return cma_save_ip_info(src_addr, dst_addr, ib_event, service_id); 13640c505f70SHaggai Eran } 13650c505f70SHaggai Eran 13664c21b5bcSHaggai Eran static int cma_save_req_info(const struct ib_cm_event *ib_event, 13674c21b5bcSHaggai Eran struct cma_req_info *req) 13684c21b5bcSHaggai Eran { 13694c21b5bcSHaggai Eran const struct ib_cm_req_event_param *req_param = 13704c21b5bcSHaggai Eran &ib_event->param.req_rcvd; 13714c21b5bcSHaggai Eran const struct ib_cm_sidr_req_event_param *sidr_param = 13724c21b5bcSHaggai Eran &ib_event->param.sidr_req_rcvd; 13734c21b5bcSHaggai Eran 13744c21b5bcSHaggai Eran switch (ib_event->event) { 13754c21b5bcSHaggai Eran case IB_CM_REQ_RECEIVED: 13764c21b5bcSHaggai Eran req->device = req_param->listen_id->device; 13774c21b5bcSHaggai Eran req->port = req_param->port; 13784c21b5bcSHaggai Eran memcpy(&req->local_gid, &req_param->primary_path->sgid, 13794c21b5bcSHaggai Eran sizeof(req->local_gid)); 13804c21b5bcSHaggai Eran req->has_gid = true; 1381d3957b86SMajd Dibbiny req->service_id = req_param->primary_path->service_id; 1382ab3964adSHaggai Eran req->pkey = be16_to_cpu(req_param->primary_path->pkey); 138384424a7fSHaggai Eran if (req->pkey != req_param->bth_pkey) 138484424a7fSHaggai Eran pr_warn_ratelimited("RDMA CMA: got different BTH P_Key (0x%x) and primary path P_Key (0x%x)\n" 138584424a7fSHaggai Eran "RDMA CMA: in the future this may cause the request to be dropped\n", 138684424a7fSHaggai Eran req_param->bth_pkey, req->pkey); 13874c21b5bcSHaggai Eran break; 13884c21b5bcSHaggai Eran case IB_CM_SIDR_REQ_RECEIVED: 13894c21b5bcSHaggai Eran req->device = sidr_param->listen_id->device; 13904c21b5bcSHaggai Eran req->port = sidr_param->port; 13914c21b5bcSHaggai Eran req->has_gid = false; 13924c21b5bcSHaggai Eran req->service_id = sidr_param->service_id; 1393ab3964adSHaggai Eran req->pkey = sidr_param->pkey; 139484424a7fSHaggai Eran if (req->pkey != sidr_param->bth_pkey) 139584424a7fSHaggai Eran pr_warn_ratelimited("RDMA CMA: got different BTH P_Key (0x%x) and SIDR request payload P_Key (0x%x)\n" 139684424a7fSHaggai Eran "RDMA CMA: in the future this may cause the request to be dropped\n", 139784424a7fSHaggai Eran sidr_param->bth_pkey, req->pkey); 13984c21b5bcSHaggai Eran break; 13994c21b5bcSHaggai Eran default: 14004c21b5bcSHaggai Eran return -EINVAL; 14014c21b5bcSHaggai Eran } 14024c21b5bcSHaggai Eran 14034c21b5bcSHaggai Eran return 0; 14044c21b5bcSHaggai Eran } 14054c21b5bcSHaggai Eran 1406f887f2acSHaggai Eran static bool validate_ipv4_net_dev(struct net_device *net_dev, 1407f887f2acSHaggai Eran const struct sockaddr_in *dst_addr, 1408f887f2acSHaggai Eran const struct sockaddr_in *src_addr) 1409f887f2acSHaggai Eran { 1410f887f2acSHaggai Eran __be32 daddr = dst_addr->sin_addr.s_addr, 1411f887f2acSHaggai Eran saddr = src_addr->sin_addr.s_addr; 1412f887f2acSHaggai Eran struct fib_result res; 1413f887f2acSHaggai Eran struct flowi4 fl4; 1414f887f2acSHaggai Eran int err; 1415f887f2acSHaggai Eran bool ret; 1416f887f2acSHaggai Eran 1417f887f2acSHaggai Eran if (ipv4_is_multicast(saddr) || ipv4_is_lbcast(saddr) || 1418f887f2acSHaggai Eran ipv4_is_lbcast(daddr) || ipv4_is_zeronet(saddr) || 1419f887f2acSHaggai Eran ipv4_is_zeronet(daddr) || ipv4_is_loopback(daddr) || 1420f887f2acSHaggai Eran ipv4_is_loopback(saddr)) 1421f887f2acSHaggai Eran return false; 1422f887f2acSHaggai Eran 1423f887f2acSHaggai Eran memset(&fl4, 0, sizeof(fl4)); 1424f887f2acSHaggai Eran fl4.flowi4_iif = net_dev->ifindex; 1425f887f2acSHaggai Eran fl4.daddr = daddr; 1426f887f2acSHaggai Eran fl4.saddr = saddr; 1427f887f2acSHaggai Eran 1428f887f2acSHaggai Eran rcu_read_lock(); 1429f887f2acSHaggai Eran err = fib_lookup(dev_net(net_dev), &fl4, &res, 0); 1430d3632493SBart Van Assche ret = err == 0 && FIB_RES_DEV(res) == net_dev; 1431f887f2acSHaggai Eran rcu_read_unlock(); 1432f887f2acSHaggai Eran 1433f887f2acSHaggai Eran return ret; 1434f887f2acSHaggai Eran } 1435f887f2acSHaggai Eran 1436f887f2acSHaggai Eran static bool validate_ipv6_net_dev(struct net_device *net_dev, 1437f887f2acSHaggai Eran const struct sockaddr_in6 *dst_addr, 1438f887f2acSHaggai Eran const struct sockaddr_in6 *src_addr) 1439f887f2acSHaggai Eran { 1440f887f2acSHaggai Eran #if IS_ENABLED(CONFIG_IPV6) 1441f887f2acSHaggai Eran const int strict = ipv6_addr_type(&dst_addr->sin6_addr) & 1442f887f2acSHaggai Eran IPV6_ADDR_LINKLOCAL; 1443f887f2acSHaggai Eran struct rt6_info *rt = rt6_lookup(dev_net(net_dev), &dst_addr->sin6_addr, 1444f887f2acSHaggai Eran &src_addr->sin6_addr, net_dev->ifindex, 1445b75cc8f9SDavid Ahern NULL, strict); 1446f887f2acSHaggai Eran bool ret; 1447f887f2acSHaggai Eran 1448f887f2acSHaggai Eran if (!rt) 1449f887f2acSHaggai Eran return false; 1450f887f2acSHaggai Eran 1451f887f2acSHaggai Eran ret = rt->rt6i_idev->dev == net_dev; 1452f887f2acSHaggai Eran ip6_rt_put(rt); 1453f887f2acSHaggai Eran 1454f887f2acSHaggai Eran return ret; 1455f887f2acSHaggai Eran #else 1456f887f2acSHaggai Eran return false; 1457f887f2acSHaggai Eran #endif 1458f887f2acSHaggai Eran } 1459f887f2acSHaggai Eran 1460f887f2acSHaggai Eran static bool validate_net_dev(struct net_device *net_dev, 1461f887f2acSHaggai Eran const struct sockaddr *daddr, 1462f887f2acSHaggai Eran const struct sockaddr *saddr) 1463f887f2acSHaggai Eran { 1464f887f2acSHaggai Eran const struct sockaddr_in *daddr4 = (const struct sockaddr_in *)daddr; 1465f887f2acSHaggai Eran const struct sockaddr_in *saddr4 = (const struct sockaddr_in *)saddr; 1466f887f2acSHaggai Eran const struct sockaddr_in6 *daddr6 = (const struct sockaddr_in6 *)daddr; 1467f887f2acSHaggai Eran const struct sockaddr_in6 *saddr6 = (const struct sockaddr_in6 *)saddr; 1468f887f2acSHaggai Eran 1469f887f2acSHaggai Eran switch (daddr->sa_family) { 1470f887f2acSHaggai Eran case AF_INET: 1471f887f2acSHaggai Eran return saddr->sa_family == AF_INET && 1472f887f2acSHaggai Eran validate_ipv4_net_dev(net_dev, daddr4, saddr4); 1473f887f2acSHaggai Eran 1474f887f2acSHaggai Eran case AF_INET6: 1475f887f2acSHaggai Eran return saddr->sa_family == AF_INET6 && 1476f887f2acSHaggai Eran validate_ipv6_net_dev(net_dev, daddr6, saddr6); 1477f887f2acSHaggai Eran 1478f887f2acSHaggai Eran default: 1479f887f2acSHaggai Eran return false; 1480f887f2acSHaggai Eran } 1481f887f2acSHaggai Eran } 1482f887f2acSHaggai Eran 1483cee10433SParav Pandit static struct net_device * 1484cee10433SParav Pandit roce_get_net_dev_by_cm_event(const struct ib_cm_event *ib_event) 1485cee10433SParav Pandit { 1486cee10433SParav Pandit const struct ib_gid_attr *sgid_attr = NULL; 1487adb4a57aSParav Pandit struct net_device *ndev; 1488cee10433SParav Pandit 1489cee10433SParav Pandit if (ib_event->event == IB_CM_REQ_RECEIVED) 1490cee10433SParav Pandit sgid_attr = ib_event->param.req_rcvd.ppath_sgid_attr; 1491cee10433SParav Pandit else if (ib_event->event == IB_CM_SIDR_REQ_RECEIVED) 1492cee10433SParav Pandit sgid_attr = ib_event->param.sidr_req_rcvd.sgid_attr; 1493cee10433SParav Pandit 1494cee10433SParav Pandit if (!sgid_attr) 1495cee10433SParav Pandit return NULL; 1496adb4a57aSParav Pandit 1497adb4a57aSParav Pandit rcu_read_lock(); 1498adb4a57aSParav Pandit ndev = rdma_read_gid_attr_ndev_rcu(sgid_attr); 1499adb4a57aSParav Pandit if (IS_ERR(ndev)) 1500adb4a57aSParav Pandit ndev = NULL; 1501adb4a57aSParav Pandit else 1502adb4a57aSParav Pandit dev_hold(ndev); 1503adb4a57aSParav Pandit rcu_read_unlock(); 1504adb4a57aSParav Pandit return ndev; 1505cee10433SParav Pandit } 1506cee10433SParav Pandit 1507e7ff98aeSParav Pandit static struct net_device *cma_get_net_dev(const struct ib_cm_event *ib_event, 15082918c1a9SParav Pandit struct cma_req_info *req) 15094c21b5bcSHaggai Eran { 15102918c1a9SParav Pandit struct sockaddr *listen_addr = 15112918c1a9SParav Pandit (struct sockaddr *)&req->listen_addr_storage; 15122918c1a9SParav Pandit struct sockaddr *src_addr = (struct sockaddr *)&req->src_addr_storage; 15134c21b5bcSHaggai Eran struct net_device *net_dev; 15144c21b5bcSHaggai Eran const union ib_gid *gid = req->has_gid ? &req->local_gid : NULL; 15154c21b5bcSHaggai Eran int err; 15164c21b5bcSHaggai Eran 1517f887f2acSHaggai Eran err = cma_save_ip_info(listen_addr, src_addr, ib_event, 1518f887f2acSHaggai Eran req->service_id); 15194c21b5bcSHaggai Eran if (err) 15204c21b5bcSHaggai Eran return ERR_PTR(err); 15214c21b5bcSHaggai Eran 1522cee10433SParav Pandit if (rdma_protocol_roce(req->device, req->port)) 1523cee10433SParav Pandit net_dev = roce_get_net_dev_by_cm_event(ib_event); 1524cee10433SParav Pandit else 1525cee10433SParav Pandit net_dev = ib_get_net_dev_by_params(req->device, req->port, 1526cee10433SParav Pandit req->pkey, 15274c21b5bcSHaggai Eran gid, listen_addr); 15284c21b5bcSHaggai Eran if (!net_dev) 15294c21b5bcSHaggai Eran return ERR_PTR(-ENODEV); 15304c21b5bcSHaggai Eran 15314c21b5bcSHaggai Eran return net_dev; 15324c21b5bcSHaggai Eran } 15334c21b5bcSHaggai Eran 15342253fc0cSSteve Wise static enum rdma_ucm_port_space rdma_ps_from_service_id(__be64 service_id) 15354c21b5bcSHaggai Eran { 15364c21b5bcSHaggai Eran return (be64_to_cpu(service_id) >> 16) & 0xffff; 15374c21b5bcSHaggai Eran } 15384c21b5bcSHaggai Eran 15394c21b5bcSHaggai Eran static bool cma_match_private_data(struct rdma_id_private *id_priv, 15404c21b5bcSHaggai Eran const struct cma_hdr *hdr) 15414c21b5bcSHaggai Eran { 15424c21b5bcSHaggai Eran struct sockaddr *addr = cma_src_addr(id_priv); 15434c21b5bcSHaggai Eran __be32 ip4_addr; 15444c21b5bcSHaggai Eran struct in6_addr ip6_addr; 15454c21b5bcSHaggai Eran 15464c21b5bcSHaggai Eran if (cma_any_addr(addr) && !id_priv->afonly) 15474c21b5bcSHaggai Eran return true; 15484c21b5bcSHaggai Eran 15494c21b5bcSHaggai Eran switch (addr->sa_family) { 15504c21b5bcSHaggai Eran case AF_INET: 15514c21b5bcSHaggai Eran ip4_addr = ((struct sockaddr_in *)addr)->sin_addr.s_addr; 15524c21b5bcSHaggai Eran if (cma_get_ip_ver(hdr) != 4) 15534c21b5bcSHaggai Eran return false; 15544c21b5bcSHaggai Eran if (!cma_any_addr(addr) && 15554c21b5bcSHaggai Eran hdr->dst_addr.ip4.addr != ip4_addr) 15564c21b5bcSHaggai Eran return false; 15574c21b5bcSHaggai Eran break; 15584c21b5bcSHaggai Eran case AF_INET6: 15594c21b5bcSHaggai Eran ip6_addr = ((struct sockaddr_in6 *)addr)->sin6_addr; 15604c21b5bcSHaggai Eran if (cma_get_ip_ver(hdr) != 6) 15614c21b5bcSHaggai Eran return false; 15624c21b5bcSHaggai Eran if (!cma_any_addr(addr) && 15634c21b5bcSHaggai Eran memcmp(&hdr->dst_addr.ip6, &ip6_addr, sizeof(ip6_addr))) 15644c21b5bcSHaggai Eran return false; 15654c21b5bcSHaggai Eran break; 15664c21b5bcSHaggai Eran case AF_IB: 15674c21b5bcSHaggai Eran return true; 15684c21b5bcSHaggai Eran default: 15694c21b5bcSHaggai Eran return false; 15704c21b5bcSHaggai Eran } 15714c21b5bcSHaggai Eran 15724c21b5bcSHaggai Eran return true; 15734c21b5bcSHaggai Eran } 15744c21b5bcSHaggai Eran 1575b8cab5daSHaggai Eran static bool cma_protocol_roce(const struct rdma_cm_id *id) 1576b8cab5daSHaggai Eran { 1577b8cab5daSHaggai Eran struct ib_device *device = id->device; 1578b8cab5daSHaggai Eran const int port_num = id->port_num ?: rdma_start_port(device); 1579b8cab5daSHaggai Eran 15805ac08a34SParav Pandit return rdma_protocol_roce(device, port_num); 1581b8cab5daSHaggai Eran } 1582b8cab5daSHaggai Eran 158378fb282bSParav Pandit static bool cma_is_req_ipv6_ll(const struct cma_req_info *req) 158478fb282bSParav Pandit { 158578fb282bSParav Pandit const struct sockaddr *daddr = 158678fb282bSParav Pandit (const struct sockaddr *)&req->listen_addr_storage; 158778fb282bSParav Pandit const struct sockaddr_in6 *daddr6 = (const struct sockaddr_in6 *)daddr; 158878fb282bSParav Pandit 158978fb282bSParav Pandit /* Returns true if the req is for IPv6 link local */ 159078fb282bSParav Pandit return (daddr->sa_family == AF_INET6 && 159178fb282bSParav Pandit (ipv6_addr_type(&daddr6->sin6_addr) & IPV6_ADDR_LINKLOCAL)); 159278fb282bSParav Pandit } 159378fb282bSParav Pandit 1594fac51590SMatan Barak static bool cma_match_net_dev(const struct rdma_cm_id *id, 1595fac51590SMatan Barak const struct net_device *net_dev, 159678fb282bSParav Pandit const struct cma_req_info *req) 15974c21b5bcSHaggai Eran { 1598fac51590SMatan Barak const struct rdma_addr *addr = &id->route.addr; 15994c21b5bcSHaggai Eran 16004c21b5bcSHaggai Eran if (!net_dev) 1601d274e45cSParav Pandit /* This request is an AF_IB request */ 160278fb282bSParav Pandit return (!id->port_num || id->port_num == req->port) && 1603d274e45cSParav Pandit (addr->src_addr.ss_family == AF_IB); 16044c21b5bcSHaggai Eran 1605643d213aSParav Pandit /* 160678fb282bSParav Pandit * If the request is not for IPv6 link local, allow matching 160778fb282bSParav Pandit * request to any netdevice of the one or multiport rdma device. 160878fb282bSParav Pandit */ 160978fb282bSParav Pandit if (!cma_is_req_ipv6_ll(req)) 161078fb282bSParav Pandit return true; 161178fb282bSParav Pandit /* 1612643d213aSParav Pandit * Net namespaces must match, and if the listner is listening 1613643d213aSParav Pandit * on a specific netdevice than netdevice must match as well. 1614643d213aSParav Pandit */ 1615643d213aSParav Pandit if (net_eq(dev_net(net_dev), addr->dev_addr.net) && 1616643d213aSParav Pandit (!!addr->dev_addr.bound_dev_if == 1617643d213aSParav Pandit (addr->dev_addr.bound_dev_if == net_dev->ifindex))) 1618643d213aSParav Pandit return true; 1619643d213aSParav Pandit else 1620643d213aSParav Pandit return false; 16214c21b5bcSHaggai Eran } 16224c21b5bcSHaggai Eran 16234c21b5bcSHaggai Eran static struct rdma_id_private *cma_find_listener( 16244c21b5bcSHaggai Eran const struct rdma_bind_list *bind_list, 16254c21b5bcSHaggai Eran const struct ib_cm_id *cm_id, 16264c21b5bcSHaggai Eran const struct ib_cm_event *ib_event, 16274c21b5bcSHaggai Eran const struct cma_req_info *req, 16284c21b5bcSHaggai Eran const struct net_device *net_dev) 16294c21b5bcSHaggai Eran { 16304c21b5bcSHaggai Eran struct rdma_id_private *id_priv, *id_priv_dev; 16314c21b5bcSHaggai Eran 1632730c8912SMark Zhang lockdep_assert_held(&lock); 1633730c8912SMark Zhang 16344c21b5bcSHaggai Eran if (!bind_list) 16354c21b5bcSHaggai Eran return ERR_PTR(-EINVAL); 16364c21b5bcSHaggai Eran 16374c21b5bcSHaggai Eran hlist_for_each_entry(id_priv, &bind_list->owners, node) { 16384c21b5bcSHaggai Eran if (cma_match_private_data(id_priv, ib_event->private_data)) { 16394c21b5bcSHaggai Eran if (id_priv->id.device == cm_id->device && 164078fb282bSParav Pandit cma_match_net_dev(&id_priv->id, net_dev, req)) 16414c21b5bcSHaggai Eran return id_priv; 16424c21b5bcSHaggai Eran list_for_each_entry(id_priv_dev, 16434c21b5bcSHaggai Eran &id_priv->listen_list, 16444c21b5bcSHaggai Eran listen_list) { 16454c21b5bcSHaggai Eran if (id_priv_dev->id.device == cm_id->device && 164678fb282bSParav Pandit cma_match_net_dev(&id_priv_dev->id, 164778fb282bSParav Pandit net_dev, req)) 16484c21b5bcSHaggai Eran return id_priv_dev; 16494c21b5bcSHaggai Eran } 16504c21b5bcSHaggai Eran } 16514c21b5bcSHaggai Eran } 16524c21b5bcSHaggai Eran 16534c21b5bcSHaggai Eran return ERR_PTR(-EINVAL); 16544c21b5bcSHaggai Eran } 16554c21b5bcSHaggai Eran 1656e7ff98aeSParav Pandit static struct rdma_id_private * 165785463316SParav Pandit cma_ib_id_from_event(struct ib_cm_id *cm_id, 1658e7ff98aeSParav Pandit const struct ib_cm_event *ib_event, 165941ab1cb7SParav Pandit struct cma_req_info *req, 16600b3ca768SHaggai Eran struct net_device **net_dev) 16614c21b5bcSHaggai Eran { 16624c21b5bcSHaggai Eran struct rdma_bind_list *bind_list; 16634c21b5bcSHaggai Eran struct rdma_id_private *id_priv; 16644c21b5bcSHaggai Eran int err; 16654c21b5bcSHaggai Eran 166641ab1cb7SParav Pandit err = cma_save_req_info(ib_event, req); 16674c21b5bcSHaggai Eran if (err) 16684c21b5bcSHaggai Eran return ERR_PTR(err); 16694c21b5bcSHaggai Eran 167041ab1cb7SParav Pandit *net_dev = cma_get_net_dev(ib_event, req); 16710b3ca768SHaggai Eran if (IS_ERR(*net_dev)) { 16720b3ca768SHaggai Eran if (PTR_ERR(*net_dev) == -EAFNOSUPPORT) { 16734c21b5bcSHaggai Eran /* Assuming the protocol is AF_IB */ 16740b3ca768SHaggai Eran *net_dev = NULL; 16754c21b5bcSHaggai Eran } else { 16760b3ca768SHaggai Eran return ERR_CAST(*net_dev); 16774c21b5bcSHaggai Eran } 16784c21b5bcSHaggai Eran } 16794c21b5bcSHaggai Eran 1680730c8912SMark Zhang mutex_lock(&lock); 16812918c1a9SParav Pandit /* 16822918c1a9SParav Pandit * Net namespace might be getting deleted while route lookup, 16832918c1a9SParav Pandit * cm_id lookup is in progress. Therefore, perform netdevice 16842918c1a9SParav Pandit * validation, cm_id lookup under rcu lock. 16852918c1a9SParav Pandit * RCU lock along with netdevice state check, synchronizes with 16862918c1a9SParav Pandit * netdevice migrating to different net namespace and also avoids 16872918c1a9SParav Pandit * case where net namespace doesn't get deleted while lookup is in 16882918c1a9SParav Pandit * progress. 16892918c1a9SParav Pandit * If the device state is not IFF_UP, its properties such as ifindex 16902918c1a9SParav Pandit * and nd_net cannot be trusted to remain valid without rcu lock. 16912918c1a9SParav Pandit * net/core/dev.c change_net_namespace() ensures to synchronize with 16922918c1a9SParav Pandit * ongoing operations on net device after device is closed using 16932918c1a9SParav Pandit * synchronize_net(). 16942918c1a9SParav Pandit */ 16952918c1a9SParav Pandit rcu_read_lock(); 16962918c1a9SParav Pandit if (*net_dev) { 16972918c1a9SParav Pandit /* 16982918c1a9SParav Pandit * If netdevice is down, it is likely that it is administratively 16992918c1a9SParav Pandit * down or it might be migrating to different namespace. 17002918c1a9SParav Pandit * In that case avoid further processing, as the net namespace 17012918c1a9SParav Pandit * or ifindex may change. 17022918c1a9SParav Pandit */ 17032918c1a9SParav Pandit if (((*net_dev)->flags & IFF_UP) == 0) { 17042918c1a9SParav Pandit id_priv = ERR_PTR(-EHOSTUNREACH); 17052918c1a9SParav Pandit goto err; 17062918c1a9SParav Pandit } 17072918c1a9SParav Pandit 17082918c1a9SParav Pandit if (!validate_net_dev(*net_dev, 170941ab1cb7SParav Pandit (struct sockaddr *)&req->listen_addr_storage, 171041ab1cb7SParav Pandit (struct sockaddr *)&req->src_addr_storage)) { 17112918c1a9SParav Pandit id_priv = ERR_PTR(-EHOSTUNREACH); 17122918c1a9SParav Pandit goto err; 17132918c1a9SParav Pandit } 17142918c1a9SParav Pandit } 17152918c1a9SParav Pandit 1716fa20105eSGuy Shapiro bind_list = cma_ps_find(*net_dev ? dev_net(*net_dev) : &init_net, 171741ab1cb7SParav Pandit rdma_ps_from_service_id(req->service_id), 171841ab1cb7SParav Pandit cma_port_from_service_id(req->service_id)); 171941ab1cb7SParav Pandit id_priv = cma_find_listener(bind_list, cm_id, ib_event, req, *net_dev); 17202918c1a9SParav Pandit err: 17212918c1a9SParav Pandit rcu_read_unlock(); 1722730c8912SMark Zhang mutex_unlock(&lock); 1723b3b51f9fSHaggai Eran if (IS_ERR(id_priv) && *net_dev) { 1724be688195SHaggai Eran dev_put(*net_dev); 1725be688195SHaggai Eran *net_dev = NULL; 1726be688195SHaggai Eran } 17274c21b5bcSHaggai Eran return id_priv; 17284c21b5bcSHaggai Eran } 17294c21b5bcSHaggai Eran 1730c0b64f58SBart Van Assche static inline u8 cma_user_data_offset(struct rdma_id_private *id_priv) 1731e51060f0SSean Hefty { 1732e8160e15SSean Hefty return cma_family(id_priv) == AF_IB ? 0 : sizeof(struct cma_hdr); 1733e51060f0SSean Hefty } 1734e51060f0SSean Hefty 1735e51060f0SSean Hefty static void cma_cancel_route(struct rdma_id_private *id_priv) 1736e51060f0SSean Hefty { 1737fe53ba2fSMichael Wang if (rdma_cap_ib_sa(id_priv->id.device, id_priv->id.port_num)) { 1738e51060f0SSean Hefty if (id_priv->query) 1739e51060f0SSean Hefty ib_sa_cancel_query(id_priv->query_id, id_priv->query); 1740e51060f0SSean Hefty } 1741e51060f0SSean Hefty } 1742e51060f0SSean Hefty 1743e51060f0SSean Hefty static void cma_cancel_listens(struct rdma_id_private *id_priv) 1744e51060f0SSean Hefty { 1745e51060f0SSean Hefty struct rdma_id_private *dev_id_priv; 1746e51060f0SSean Hefty 1747d02d1f53SSean Hefty /* 1748d02d1f53SSean Hefty * Remove from listen_any_list to prevent added devices from spawning 1749d02d1f53SSean Hefty * additional listen requests. 1750d02d1f53SSean Hefty */ 1751e51060f0SSean Hefty mutex_lock(&lock); 1752e51060f0SSean Hefty list_del(&id_priv->list); 1753e51060f0SSean Hefty 1754e51060f0SSean Hefty while (!list_empty(&id_priv->listen_list)) { 1755e51060f0SSean Hefty dev_id_priv = list_entry(id_priv->listen_list.next, 1756e51060f0SSean Hefty struct rdma_id_private, listen_list); 1757d02d1f53SSean Hefty /* sync with device removal to avoid duplicate destruction */ 1758d02d1f53SSean Hefty list_del_init(&dev_id_priv->list); 1759d02d1f53SSean Hefty list_del(&dev_id_priv->listen_list); 1760d02d1f53SSean Hefty mutex_unlock(&lock); 1761d02d1f53SSean Hefty 1762d02d1f53SSean Hefty rdma_destroy_id(&dev_id_priv->id); 1763d02d1f53SSean Hefty mutex_lock(&lock); 1764e51060f0SSean Hefty } 1765e51060f0SSean Hefty mutex_unlock(&lock); 1766e51060f0SSean Hefty } 1767e51060f0SSean Hefty 1768e51060f0SSean Hefty static void cma_cancel_operation(struct rdma_id_private *id_priv, 1769550e5ca7SNir Muchtar enum rdma_cm_state state) 1770e51060f0SSean Hefty { 1771e51060f0SSean Hefty switch (state) { 1772550e5ca7SNir Muchtar case RDMA_CM_ADDR_QUERY: 1773e51060f0SSean Hefty rdma_addr_cancel(&id_priv->id.route.addr.dev_addr); 1774e51060f0SSean Hefty break; 1775550e5ca7SNir Muchtar case RDMA_CM_ROUTE_QUERY: 1776e51060f0SSean Hefty cma_cancel_route(id_priv); 1777e51060f0SSean Hefty break; 1778550e5ca7SNir Muchtar case RDMA_CM_LISTEN: 1779f4753834SSean Hefty if (cma_any_addr(cma_src_addr(id_priv)) && !id_priv->cma_dev) 1780e51060f0SSean Hefty cma_cancel_listens(id_priv); 1781e51060f0SSean Hefty break; 1782e51060f0SSean Hefty default: 1783e51060f0SSean Hefty break; 1784e51060f0SSean Hefty } 1785e51060f0SSean Hefty } 1786e51060f0SSean Hefty 1787e51060f0SSean Hefty static void cma_release_port(struct rdma_id_private *id_priv) 1788e51060f0SSean Hefty { 1789e51060f0SSean Hefty struct rdma_bind_list *bind_list = id_priv->bind_list; 1790fa20105eSGuy Shapiro struct net *net = id_priv->id.route.addr.dev_addr.net; 1791e51060f0SSean Hefty 1792e51060f0SSean Hefty if (!bind_list) 1793e51060f0SSean Hefty return; 1794e51060f0SSean Hefty 1795e51060f0SSean Hefty mutex_lock(&lock); 1796e51060f0SSean Hefty hlist_del(&id_priv->node); 1797e51060f0SSean Hefty if (hlist_empty(&bind_list->owners)) { 1798fa20105eSGuy Shapiro cma_ps_remove(net, bind_list->ps, bind_list->port); 1799e51060f0SSean Hefty kfree(bind_list); 1800e51060f0SSean Hefty } 1801e51060f0SSean Hefty mutex_unlock(&lock); 1802e51060f0SSean Hefty } 1803e51060f0SSean Hefty 18043788d299SJason Gunthorpe static void destroy_mc(struct rdma_id_private *id_priv, 180588145678SParav Pandit struct cma_multicast *mc) 180688145678SParav Pandit { 1807b5de0c60SJason Gunthorpe if (rdma_cap_ib_mcast(id_priv->id.device, id_priv->id.port_num)) 1808b5de0c60SJason Gunthorpe ib_sa_free_multicast(mc->sa_mc); 18093788d299SJason Gunthorpe 1810b5de0c60SJason Gunthorpe if (rdma_protocol_roce(id_priv->id.device, id_priv->id.port_num)) { 18113788d299SJason Gunthorpe struct rdma_dev_addr *dev_addr = 18123788d299SJason Gunthorpe &id_priv->id.route.addr.dev_addr; 181388145678SParav Pandit struct net_device *ndev = NULL; 181488145678SParav Pandit 181588145678SParav Pandit if (dev_addr->bound_dev_if) 18163788d299SJason Gunthorpe ndev = dev_get_by_index(dev_addr->net, 18173788d299SJason Gunthorpe dev_addr->bound_dev_if); 181888145678SParav Pandit if (ndev) { 1819b5de0c60SJason Gunthorpe union ib_gid mgid; 1820b5de0c60SJason Gunthorpe 1821b5de0c60SJason Gunthorpe cma_set_mgid(id_priv, (struct sockaddr *)&mc->addr, 1822b5de0c60SJason Gunthorpe &mgid); 1823b5de0c60SJason Gunthorpe cma_igmp_send(ndev, &mgid, false); 182488145678SParav Pandit dev_put(ndev); 182588145678SParav Pandit } 182688145678SParav Pandit } 1827b5de0c60SJason Gunthorpe kfree(mc); 182888145678SParav Pandit } 182988145678SParav Pandit 1830c8f6a362SSean Hefty static void cma_leave_mc_groups(struct rdma_id_private *id_priv) 1831c8f6a362SSean Hefty { 1832c8f6a362SSean Hefty struct cma_multicast *mc; 1833c8f6a362SSean Hefty 1834c8f6a362SSean Hefty while (!list_empty(&id_priv->mc_list)) { 18353788d299SJason Gunthorpe mc = list_first_entry(&id_priv->mc_list, struct cma_multicast, 18363788d299SJason Gunthorpe list); 1837c8f6a362SSean Hefty list_del(&mc->list); 18383788d299SJason Gunthorpe destroy_mc(id_priv, mc); 1839c8f6a362SSean Hefty } 1840bee3c3c9SMoni Shoua } 1841c8f6a362SSean Hefty 1842f6a9d47aSJason Gunthorpe static void _destroy_id(struct rdma_id_private *id_priv, 1843f6a9d47aSJason Gunthorpe enum rdma_cm_state state) 1844e51060f0SSean Hefty { 1845e51060f0SSean Hefty cma_cancel_operation(id_priv, state); 1846e51060f0SSean Hefty 1847ed7a01fdSLeon Romanovsky if (id_priv->cma_dev) { 184872219ceaSMichael Wang if (rdma_cap_ib_cm(id_priv->id.device, 1)) { 18490c9361fcSJack Morgenstein if (id_priv->cm_id.ib) 1850e51060f0SSean Hefty ib_destroy_cm_id(id_priv->cm_id.ib); 185104215330SMichael Wang } else if (rdma_cap_iw_cm(id_priv->id.device, 1)) { 18520c9361fcSJack Morgenstein if (id_priv->cm_id.iw) 185307ebafbaSTom Tucker iw_destroy_cm_id(id_priv->cm_id.iw); 1854e51060f0SSean Hefty } 1855c8f6a362SSean Hefty cma_leave_mc_groups(id_priv); 1856a396d43aSSean Hefty cma_release_dev(id_priv); 1857e51060f0SSean Hefty } 1858e51060f0SSean Hefty 1859e51060f0SSean Hefty cma_release_port(id_priv); 1860e368d23fSParav Pandit cma_id_put(id_priv); 1861e51060f0SSean Hefty wait_for_completion(&id_priv->comp); 1862e51060f0SSean Hefty 1863d02d1f53SSean Hefty if (id_priv->internal_id) 1864e368d23fSParav Pandit cma_id_put(id_priv->id.context); 1865d02d1f53SSean Hefty 1866e51060f0SSean Hefty kfree(id_priv->id.route.path_rec); 18674ed13a5fSParav Pandit 1868fa20105eSGuy Shapiro put_net(id_priv->id.route.addr.dev_addr.net); 186960aaeffaSLeon Romanovsky rdma_restrack_del(&id_priv->res); 1870e51060f0SSean Hefty kfree(id_priv); 1871e51060f0SSean Hefty } 1872f6a9d47aSJason Gunthorpe 1873f6a9d47aSJason Gunthorpe /* 1874f6a9d47aSJason Gunthorpe * destroy an ID from within the handler_mutex. This ensures that no other 1875f6a9d47aSJason Gunthorpe * handlers can start running concurrently. 1876f6a9d47aSJason Gunthorpe */ 1877f6a9d47aSJason Gunthorpe static void destroy_id_handler_unlock(struct rdma_id_private *id_priv) 1878f6a9d47aSJason Gunthorpe __releases(&idprv->handler_mutex) 1879f6a9d47aSJason Gunthorpe { 1880f6a9d47aSJason Gunthorpe enum rdma_cm_state state; 1881f6a9d47aSJason Gunthorpe unsigned long flags; 1882f6a9d47aSJason Gunthorpe 1883f6a9d47aSJason Gunthorpe trace_cm_id_destroy(id_priv); 1884f6a9d47aSJason Gunthorpe 1885f6a9d47aSJason Gunthorpe /* 1886f6a9d47aSJason Gunthorpe * Setting the state to destroyed under the handler mutex provides a 1887f6a9d47aSJason Gunthorpe * fence against calling handler callbacks. If this is invoked due to 1888f6a9d47aSJason Gunthorpe * the failure of a handler callback then it guarentees that no future 1889f6a9d47aSJason Gunthorpe * handlers will be called. 1890f6a9d47aSJason Gunthorpe */ 1891f6a9d47aSJason Gunthorpe lockdep_assert_held(&id_priv->handler_mutex); 1892f6a9d47aSJason Gunthorpe spin_lock_irqsave(&id_priv->lock, flags); 1893f6a9d47aSJason Gunthorpe state = id_priv->state; 1894f6a9d47aSJason Gunthorpe id_priv->state = RDMA_CM_DESTROYING; 1895f6a9d47aSJason Gunthorpe spin_unlock_irqrestore(&id_priv->lock, flags); 1896f6a9d47aSJason Gunthorpe mutex_unlock(&id_priv->handler_mutex); 1897f6a9d47aSJason Gunthorpe _destroy_id(id_priv, state); 1898f6a9d47aSJason Gunthorpe } 1899f6a9d47aSJason Gunthorpe 1900f6a9d47aSJason Gunthorpe void rdma_destroy_id(struct rdma_cm_id *id) 1901f6a9d47aSJason Gunthorpe { 1902f6a9d47aSJason Gunthorpe struct rdma_id_private *id_priv = 1903f6a9d47aSJason Gunthorpe container_of(id, struct rdma_id_private, id); 1904f6a9d47aSJason Gunthorpe 1905f6a9d47aSJason Gunthorpe mutex_lock(&id_priv->handler_mutex); 1906f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(id_priv); 1907f6a9d47aSJason Gunthorpe } 1908e51060f0SSean Hefty EXPORT_SYMBOL(rdma_destroy_id); 1909e51060f0SSean Hefty 1910e51060f0SSean Hefty static int cma_rep_recv(struct rdma_id_private *id_priv) 1911e51060f0SSean Hefty { 1912e51060f0SSean Hefty int ret; 1913e51060f0SSean Hefty 19145851bb89SSean Hefty ret = cma_modify_qp_rtr(id_priv, NULL); 1915e51060f0SSean Hefty if (ret) 1916e51060f0SSean Hefty goto reject; 1917e51060f0SSean Hefty 19185851bb89SSean Hefty ret = cma_modify_qp_rts(id_priv, NULL); 1919e51060f0SSean Hefty if (ret) 1920e51060f0SSean Hefty goto reject; 1921e51060f0SSean Hefty 1922ed999f82SChuck Lever trace_cm_send_rtu(id_priv); 1923e51060f0SSean Hefty ret = ib_send_cm_rtu(id_priv->cm_id.ib, NULL, 0); 1924e51060f0SSean Hefty if (ret) 1925e51060f0SSean Hefty goto reject; 1926e51060f0SSean Hefty 1927e51060f0SSean Hefty return 0; 1928e51060f0SSean Hefty reject: 1929498683c6SMoni Shoua pr_debug_ratelimited("RDMA CM: CONNECT_ERROR: failed to handle reply. status %d\n", ret); 1930c5483388SSean Hefty cma_modify_qp_err(id_priv); 1931ed999f82SChuck Lever trace_cm_send_rej(id_priv); 1932e51060f0SSean Hefty ib_send_cm_rej(id_priv->cm_id.ib, IB_CM_REJ_CONSUMER_DEFINED, 1933e51060f0SSean Hefty NULL, 0, NULL, 0); 1934e51060f0SSean Hefty return ret; 1935e51060f0SSean Hefty } 1936e51060f0SSean Hefty 1937a1b1b61fSSean Hefty static void cma_set_rep_event_data(struct rdma_cm_event *event, 1938e7ff98aeSParav Pandit const struct ib_cm_rep_event_param *rep_data, 1939a1b1b61fSSean Hefty void *private_data) 1940a1b1b61fSSean Hefty { 1941a1b1b61fSSean Hefty event->param.conn.private_data = private_data; 1942a1b1b61fSSean Hefty event->param.conn.private_data_len = IB_CM_REP_PRIVATE_DATA_SIZE; 1943a1b1b61fSSean Hefty event->param.conn.responder_resources = rep_data->responder_resources; 1944a1b1b61fSSean Hefty event->param.conn.initiator_depth = rep_data->initiator_depth; 1945a1b1b61fSSean Hefty event->param.conn.flow_control = rep_data->flow_control; 1946a1b1b61fSSean Hefty event->param.conn.rnr_retry_count = rep_data->rnr_retry_count; 1947a1b1b61fSSean Hefty event->param.conn.srq = rep_data->srq; 1948a1b1b61fSSean Hefty event->param.conn.qp_num = rep_data->remote_qpn; 1949a20652e1SLeon Romanovsky 1950a20652e1SLeon Romanovsky event->ece.vendor_id = rep_data->ece.vendor_id; 1951a20652e1SLeon Romanovsky event->ece.attr_mod = rep_data->ece.attr_mod; 1952a1b1b61fSSean Hefty } 1953a1b1b61fSSean Hefty 1954ed999f82SChuck Lever static int cma_cm_event_handler(struct rdma_id_private *id_priv, 1955ed999f82SChuck Lever struct rdma_cm_event *event) 1956ed999f82SChuck Lever { 1957ed999f82SChuck Lever int ret; 1958ed999f82SChuck Lever 19593647a28dSJason Gunthorpe lockdep_assert_held(&id_priv->handler_mutex); 19603647a28dSJason Gunthorpe 1961ed999f82SChuck Lever trace_cm_event_handler(id_priv, event); 1962ed999f82SChuck Lever ret = id_priv->id.event_handler(&id_priv->id, event); 1963ed999f82SChuck Lever trace_cm_event_done(id_priv, event, ret); 1964ed999f82SChuck Lever return ret; 1965ed999f82SChuck Lever } 1966ed999f82SChuck Lever 1967e7ff98aeSParav Pandit static int cma_ib_handler(struct ib_cm_id *cm_id, 1968e7ff98aeSParav Pandit const struct ib_cm_event *ib_event) 1969e51060f0SSean Hefty { 1970e51060f0SSean Hefty struct rdma_id_private *id_priv = cm_id->context; 19717582df82SParav Pandit struct rdma_cm_event event = {}; 19722a7cec53SJason Gunthorpe enum rdma_cm_state state; 1973f6a9d47aSJason Gunthorpe int ret; 1974e51060f0SSean Hefty 197537e07cdaSBart Van Assche mutex_lock(&id_priv->handler_mutex); 19762a7cec53SJason Gunthorpe state = READ_ONCE(id_priv->state); 197738ca83a5SAmir Vadai if ((ib_event->event != IB_CM_TIMEWAIT_EXIT && 19782a7cec53SJason Gunthorpe state != RDMA_CM_CONNECT) || 197938ca83a5SAmir Vadai (ib_event->event == IB_CM_TIMEWAIT_EXIT && 19802a7cec53SJason Gunthorpe state != RDMA_CM_DISCONNECT)) 198137e07cdaSBart Van Assche goto out; 1982e51060f0SSean Hefty 1983e51060f0SSean Hefty switch (ib_event->event) { 1984e51060f0SSean Hefty case IB_CM_REQ_ERROR: 1985e51060f0SSean Hefty case IB_CM_REP_ERROR: 1986a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_UNREACHABLE; 1987a1b1b61fSSean Hefty event.status = -ETIMEDOUT; 1988e51060f0SSean Hefty break; 1989e51060f0SSean Hefty case IB_CM_REP_RECEIVED: 19902a7cec53SJason Gunthorpe if (state == RDMA_CM_CONNECT && 1991ed999f82SChuck Lever (id_priv->id.qp_type != IB_QPT_UD)) { 1992ed999f82SChuck Lever trace_cm_send_mra(id_priv); 199361c0ddbeSMoni Shoua ib_send_cm_mra(cm_id, CMA_CM_MRA_SETTING, NULL, 0); 1994ed999f82SChuck Lever } 199501602f11SSean Hefty if (id_priv->id.qp) { 1996a1b1b61fSSean Hefty event.status = cma_rep_recv(id_priv); 1997a1b1b61fSSean Hefty event.event = event.status ? RDMA_CM_EVENT_CONNECT_ERROR : 1998e51060f0SSean Hefty RDMA_CM_EVENT_ESTABLISHED; 199901602f11SSean Hefty } else { 2000a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_CONNECT_RESPONSE; 200101602f11SSean Hefty } 2002a1b1b61fSSean Hefty cma_set_rep_event_data(&event, &ib_event->param.rep_rcvd, 2003a1b1b61fSSean Hefty ib_event->private_data); 2004e51060f0SSean Hefty break; 2005e51060f0SSean Hefty case IB_CM_RTU_RECEIVED: 20060fe313b0SSean Hefty case IB_CM_USER_ESTABLISHED: 20070fe313b0SSean Hefty event.event = RDMA_CM_EVENT_ESTABLISHED; 2008e51060f0SSean Hefty break; 2009e51060f0SSean Hefty case IB_CM_DREQ_ERROR: 2010df561f66SGustavo A. R. Silva event.status = -ETIMEDOUT; 2011df561f66SGustavo A. R. Silva fallthrough; 2012e51060f0SSean Hefty case IB_CM_DREQ_RECEIVED: 2013e51060f0SSean Hefty case IB_CM_DREP_RECEIVED: 2014550e5ca7SNir Muchtar if (!cma_comp_exch(id_priv, RDMA_CM_CONNECT, 2015550e5ca7SNir Muchtar RDMA_CM_DISCONNECT)) 2016e51060f0SSean Hefty goto out; 2017a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_DISCONNECTED; 2018e51060f0SSean Hefty break; 2019e51060f0SSean Hefty case IB_CM_TIMEWAIT_EXIT: 202038ca83a5SAmir Vadai event.event = RDMA_CM_EVENT_TIMEWAIT_EXIT; 202138ca83a5SAmir Vadai break; 2022e51060f0SSean Hefty case IB_CM_MRA_RECEIVED: 2023e51060f0SSean Hefty /* ignore event */ 2024e51060f0SSean Hefty goto out; 2025e51060f0SSean Hefty case IB_CM_REJ_RECEIVED: 2026498683c6SMoni Shoua pr_debug_ratelimited("RDMA CM: REJECTED: %s\n", rdma_reject_msg(&id_priv->id, 2027498683c6SMoni Shoua ib_event->param.rej_rcvd.reason)); 2028c5483388SSean Hefty cma_modify_qp_err(id_priv); 2029a1b1b61fSSean Hefty event.status = ib_event->param.rej_rcvd.reason; 2030a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_REJECTED; 2031a1b1b61fSSean Hefty event.param.conn.private_data = ib_event->private_data; 2032a1b1b61fSSean Hefty event.param.conn.private_data_len = IB_CM_REJ_PRIVATE_DATA_SIZE; 2033e51060f0SSean Hefty break; 2034e51060f0SSean Hefty default: 2035aba25a3eSParav Pandit pr_err("RDMA CMA: unexpected IB CM event: %d\n", 2036e51060f0SSean Hefty ib_event->event); 2037e51060f0SSean Hefty goto out; 2038e51060f0SSean Hefty } 2039e51060f0SSean Hefty 2040ed999f82SChuck Lever ret = cma_cm_event_handler(id_priv, &event); 2041e51060f0SSean Hefty if (ret) { 2042e51060f0SSean Hefty /* Destroy the CM ID by returning a non-zero value. */ 2043e51060f0SSean Hefty id_priv->cm_id.ib = NULL; 2044f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(id_priv); 2045e51060f0SSean Hefty return ret; 2046e51060f0SSean Hefty } 2047e51060f0SSean Hefty out: 2048de910bd9SOr Gerlitz mutex_unlock(&id_priv->handler_mutex); 2049f6a9d47aSJason Gunthorpe return 0; 2050e51060f0SSean Hefty } 2051e51060f0SSean Hefty 2052e7ff98aeSParav Pandit static struct rdma_id_private * 205385463316SParav Pandit cma_ib_new_conn_id(const struct rdma_cm_id *listen_id, 2054e7ff98aeSParav Pandit const struct ib_cm_event *ib_event, 20550b3ca768SHaggai Eran struct net_device *net_dev) 2056e51060f0SSean Hefty { 205700313983SSteve Wise struct rdma_id_private *listen_id_priv; 2058e51060f0SSean Hefty struct rdma_id_private *id_priv; 2059e51060f0SSean Hefty struct rdma_cm_id *id; 2060e51060f0SSean Hefty struct rdma_route *rt; 20610c505f70SHaggai Eran const sa_family_t ss_family = listen_id->route.addr.src_addr.ss_family; 20629fdca4daSDasaratharaman Chandramouli struct sa_path_rec *path = ib_event->param.req_rcvd.primary_path; 2063d3957b86SMajd Dibbiny const __be64 service_id = 2064d3957b86SMajd Dibbiny ib_event->param.req_rcvd.primary_path->service_id; 206564c5e613SOr Gerlitz int ret; 2066e51060f0SSean Hefty 206700313983SSteve Wise listen_id_priv = container_of(listen_id, struct rdma_id_private, id); 2068b09c4d70SLeon Romanovsky id_priv = __rdma_create_id(listen_id->route.addr.dev_addr.net, 2069fa20105eSGuy Shapiro listen_id->event_handler, listen_id->context, 2070b09c4d70SLeon Romanovsky listen_id->ps, 2071b09c4d70SLeon Romanovsky ib_event->param.req_rcvd.qp_type, 2072b09c4d70SLeon Romanovsky listen_id_priv); 2073b09c4d70SLeon Romanovsky if (IS_ERR(id_priv)) 20740c9361fcSJack Morgenstein return NULL; 20753f168d2bSKrishna Kumar 2076b09c4d70SLeon Romanovsky id = &id_priv->id; 20770c505f70SHaggai Eran if (cma_save_net_info((struct sockaddr *)&id->route.addr.src_addr, 20780c505f70SHaggai Eran (struct sockaddr *)&id->route.addr.dst_addr, 20790c505f70SHaggai Eran listen_id, ib_event, ss_family, service_id)) 2080fbaa1a6dSSean Hefty goto err; 20813f168d2bSKrishna Kumar 20823f168d2bSKrishna Kumar rt = &id->route; 20833f168d2bSKrishna Kumar rt->num_paths = ib_event->param.req_rcvd.alternate_path ? 2 : 1; 20846da2ec56SKees Cook rt->path_rec = kmalloc_array(rt->num_paths, sizeof(*rt->path_rec), 20853f168d2bSKrishna Kumar GFP_KERNEL); 20863f168d2bSKrishna Kumar if (!rt->path_rec) 20870c9361fcSJack Morgenstein goto err; 20883f168d2bSKrishna Kumar 20899fdca4daSDasaratharaman Chandramouli rt->path_rec[0] = *path; 2090e51060f0SSean Hefty if (rt->num_paths == 2) 2091e51060f0SSean Hefty rt->path_rec[1] = *ib_event->param.req_rcvd.alternate_path; 2092e51060f0SSean Hefty 20930b3ca768SHaggai Eran if (net_dev) { 209477addc52SParav Pandit rdma_copy_src_l2_addr(&rt->addr.dev_addr, net_dev); 20950b3ca768SHaggai Eran } else { 2096b8cab5daSHaggai Eran if (!cma_protocol_roce(listen_id) && 2097b8cab5daSHaggai Eran cma_any_addr(cma_src_addr(id_priv))) { 2098b8cab5daSHaggai Eran rt->addr.dev_addr.dev_type = ARPHRD_INFINIBAND; 2099b8cab5daSHaggai Eran rdma_addr_set_sgid(&rt->addr.dev_addr, &rt->path_rec[0].sgid); 2100b8cab5daSHaggai Eran ib_addr_set_pkey(&rt->addr.dev_addr, be16_to_cpu(rt->path_rec[0].pkey)); 2101b8cab5daSHaggai Eran } else if (!cma_any_addr(cma_src_addr(id_priv))) { 2102b8cab5daSHaggai Eran ret = cma_translate_addr(cma_src_addr(id_priv), &rt->addr.dev_addr); 2103b8cab5daSHaggai Eran if (ret) 2104b8cab5daSHaggai Eran goto err; 2105b8cab5daSHaggai Eran } 21066f8372b6SSean Hefty } 21076f8372b6SSean Hefty rdma_addr_set_dgid(&rt->addr.dev_addr, &rt->path_rec[0].dgid); 2108e51060f0SSean Hefty 2109550e5ca7SNir Muchtar id_priv->state = RDMA_CM_CONNECT; 2110e51060f0SSean Hefty return id_priv; 21113f168d2bSKrishna Kumar 21123f168d2bSKrishna Kumar err: 21130c9361fcSJack Morgenstein rdma_destroy_id(id); 2114e51060f0SSean Hefty return NULL; 2115e51060f0SSean Hefty } 2116e51060f0SSean Hefty 2117e7ff98aeSParav Pandit static struct rdma_id_private * 211885463316SParav Pandit cma_ib_new_udp_id(const struct rdma_cm_id *listen_id, 2119e7ff98aeSParav Pandit const struct ib_cm_event *ib_event, 21200b3ca768SHaggai Eran struct net_device *net_dev) 2121628e5f6dSSean Hefty { 2122e7ff98aeSParav Pandit const struct rdma_id_private *listen_id_priv; 2123628e5f6dSSean Hefty struct rdma_id_private *id_priv; 2124628e5f6dSSean Hefty struct rdma_cm_id *id; 21250c505f70SHaggai Eran const sa_family_t ss_family = listen_id->route.addr.src_addr.ss_family; 2126fa20105eSGuy Shapiro struct net *net = listen_id->route.addr.dev_addr.net; 2127628e5f6dSSean Hefty int ret; 2128628e5f6dSSean Hefty 212900313983SSteve Wise listen_id_priv = container_of(listen_id, struct rdma_id_private, id); 2130b09c4d70SLeon Romanovsky id_priv = __rdma_create_id(net, listen_id->event_handler, 2131b09c4d70SLeon Romanovsky listen_id->context, listen_id->ps, IB_QPT_UD, 2132b09c4d70SLeon Romanovsky listen_id_priv); 2133b09c4d70SLeon Romanovsky if (IS_ERR(id_priv)) 2134628e5f6dSSean Hefty return NULL; 2135628e5f6dSSean Hefty 2136b09c4d70SLeon Romanovsky id = &id_priv->id; 21370c505f70SHaggai Eran if (cma_save_net_info((struct sockaddr *)&id->route.addr.src_addr, 21380c505f70SHaggai Eran (struct sockaddr *)&id->route.addr.dst_addr, 21390c505f70SHaggai Eran listen_id, ib_event, ss_family, 21400c505f70SHaggai Eran ib_event->param.sidr_req_rcvd.service_id)) 2141628e5f6dSSean Hefty goto err; 2142628e5f6dSSean Hefty 21430b3ca768SHaggai Eran if (net_dev) { 214477addc52SParav Pandit rdma_copy_src_l2_addr(&id->route.addr.dev_addr, net_dev); 21450b3ca768SHaggai Eran } else { 2146b8cab5daSHaggai Eran if (!cma_any_addr(cma_src_addr(id_priv))) { 2147b8cab5daSHaggai Eran ret = cma_translate_addr(cma_src_addr(id_priv), 21480b3ca768SHaggai Eran &id->route.addr.dev_addr); 2149b8cab5daSHaggai Eran if (ret) 2150b8cab5daSHaggai Eran goto err; 2151b8cab5daSHaggai Eran } 21526f8372b6SSean Hefty } 2153628e5f6dSSean Hefty 2154550e5ca7SNir Muchtar id_priv->state = RDMA_CM_CONNECT; 2155628e5f6dSSean Hefty return id_priv; 2156628e5f6dSSean Hefty err: 2157628e5f6dSSean Hefty rdma_destroy_id(id); 2158628e5f6dSSean Hefty return NULL; 2159628e5f6dSSean Hefty } 2160628e5f6dSSean Hefty 2161a1b1b61fSSean Hefty static void cma_set_req_event_data(struct rdma_cm_event *event, 2162e7ff98aeSParav Pandit const struct ib_cm_req_event_param *req_data, 2163a1b1b61fSSean Hefty void *private_data, int offset) 2164a1b1b61fSSean Hefty { 2165a1b1b61fSSean Hefty event->param.conn.private_data = private_data + offset; 2166a1b1b61fSSean Hefty event->param.conn.private_data_len = IB_CM_REQ_PRIVATE_DATA_SIZE - offset; 2167a1b1b61fSSean Hefty event->param.conn.responder_resources = req_data->responder_resources; 2168a1b1b61fSSean Hefty event->param.conn.initiator_depth = req_data->initiator_depth; 2169a1b1b61fSSean Hefty event->param.conn.flow_control = req_data->flow_control; 2170a1b1b61fSSean Hefty event->param.conn.retry_count = req_data->retry_count; 2171a1b1b61fSSean Hefty event->param.conn.rnr_retry_count = req_data->rnr_retry_count; 2172a1b1b61fSSean Hefty event->param.conn.srq = req_data->srq; 2173a1b1b61fSSean Hefty event->param.conn.qp_num = req_data->remote_qpn; 2174a20652e1SLeon Romanovsky 2175a20652e1SLeon Romanovsky event->ece.vendor_id = req_data->ece.vendor_id; 2176a20652e1SLeon Romanovsky event->ece.attr_mod = req_data->ece.attr_mod; 2177a1b1b61fSSean Hefty } 2178a1b1b61fSSean Hefty 217985463316SParav Pandit static int cma_ib_check_req_qp_type(const struct rdma_cm_id *id, 2180e7ff98aeSParav Pandit const struct ib_cm_event *ib_event) 21819595480cSHefty, Sean { 21824dd81e89SSean Hefty return (((ib_event->event == IB_CM_REQ_RECEIVED) && 21839595480cSHefty, Sean (ib_event->param.req_rcvd.qp_type == id->qp_type)) || 21849595480cSHefty, Sean ((ib_event->event == IB_CM_SIDR_REQ_RECEIVED) && 21859595480cSHefty, Sean (id->qp_type == IB_QPT_UD)) || 21869595480cSHefty, Sean (!id->qp_type)); 21879595480cSHefty, Sean } 21889595480cSHefty, Sean 218985463316SParav Pandit static int cma_ib_req_handler(struct ib_cm_id *cm_id, 2190e7ff98aeSParav Pandit const struct ib_cm_event *ib_event) 2191e51060f0SSean Hefty { 219237e07cdaSBart Van Assche struct rdma_id_private *listen_id, *conn_id = NULL; 21937582df82SParav Pandit struct rdma_cm_event event = {}; 219441ab1cb7SParav Pandit struct cma_req_info req = {}; 21950b3ca768SHaggai Eran struct net_device *net_dev; 2196c0b64f58SBart Van Assche u8 offset; 2197c0b64f58SBart Van Assche int ret; 2198e51060f0SSean Hefty 219941ab1cb7SParav Pandit listen_id = cma_ib_id_from_event(cm_id, ib_event, &req, &net_dev); 22004c21b5bcSHaggai Eran if (IS_ERR(listen_id)) 22014c21b5bcSHaggai Eran return PTR_ERR(listen_id); 22024c21b5bcSHaggai Eran 2203ed999f82SChuck Lever trace_cm_req_handler(listen_id, ib_event->event); 220485463316SParav Pandit if (!cma_ib_check_req_qp_type(&listen_id->id, ib_event)) { 22050b3ca768SHaggai Eran ret = -EINVAL; 22060b3ca768SHaggai Eran goto net_dev_put; 22070b3ca768SHaggai Eran } 22089595480cSHefty, Sean 220937e07cdaSBart Van Assche mutex_lock(&listen_id->handler_mutex); 2210d490ee52SJason Gunthorpe if (READ_ONCE(listen_id->state) != RDMA_CM_LISTEN) { 22110b3ca768SHaggai Eran ret = -ECONNABORTED; 2212f6a9d47aSJason Gunthorpe goto err_unlock; 22130b3ca768SHaggai Eran } 2214e51060f0SSean Hefty 2215e8160e15SSean Hefty offset = cma_user_data_offset(listen_id); 2216628e5f6dSSean Hefty event.event = RDMA_CM_EVENT_CONNECT_REQUEST; 22179595480cSHefty, Sean if (ib_event->event == IB_CM_SIDR_REQ_RECEIVED) { 221885463316SParav Pandit conn_id = cma_ib_new_udp_id(&listen_id->id, ib_event, net_dev); 2219628e5f6dSSean Hefty event.param.ud.private_data = ib_event->private_data + offset; 2220628e5f6dSSean Hefty event.param.ud.private_data_len = 2221628e5f6dSSean Hefty IB_CM_SIDR_REQ_PRIVATE_DATA_SIZE - offset; 2222628e5f6dSSean Hefty } else { 222385463316SParav Pandit conn_id = cma_ib_new_conn_id(&listen_id->id, ib_event, net_dev); 2224628e5f6dSSean Hefty cma_set_req_event_data(&event, &ib_event->param.req_rcvd, 2225628e5f6dSSean Hefty ib_event->private_data, offset); 2226628e5f6dSSean Hefty } 2227e51060f0SSean Hefty if (!conn_id) { 2228e51060f0SSean Hefty ret = -ENOMEM; 2229f6a9d47aSJason Gunthorpe goto err_unlock; 2230e51060f0SSean Hefty } 2231e51060f0SSean Hefty 2232de910bd9SOr Gerlitz mutex_lock_nested(&conn_id->handler_mutex, SINGLE_DEPTH_NESTING); 223341ab1cb7SParav Pandit ret = cma_ib_acquire_dev(conn_id, listen_id, &req); 2234f6a9d47aSJason Gunthorpe if (ret) { 2235f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(conn_id); 2236f6a9d47aSJason Gunthorpe goto err_unlock; 2237f6a9d47aSJason Gunthorpe } 2238e51060f0SSean Hefty 2239e51060f0SSean Hefty conn_id->cm_id.ib = cm_id; 2240e51060f0SSean Hefty cm_id->context = conn_id; 2241e51060f0SSean Hefty cm_id->cm_handler = cma_ib_handler; 2242e51060f0SSean Hefty 2243ed999f82SChuck Lever ret = cma_cm_event_handler(conn_id, &event); 2244f6a9d47aSJason Gunthorpe if (ret) { 2245f6a9d47aSJason Gunthorpe /* Destroy the CM ID by returning a non-zero value. */ 2246f6a9d47aSJason Gunthorpe conn_id->cm_id.ib = NULL; 2247f6a9d47aSJason Gunthorpe mutex_unlock(&listen_id->handler_mutex); 2248f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(conn_id); 2249f6a9d47aSJason Gunthorpe goto net_dev_put; 2250f6a9d47aSJason Gunthorpe } 2251f6a9d47aSJason Gunthorpe 22522a7cec53SJason Gunthorpe if (READ_ONCE(conn_id->state) == RDMA_CM_CONNECT && 22532a7cec53SJason Gunthorpe conn_id->id.qp_type != IB_QPT_UD) { 2254ed999f82SChuck Lever trace_cm_send_mra(cm_id->context); 2255ead595aeSSean Hefty ib_send_cm_mra(cm_id, CMA_CM_MRA_SETTING, NULL, 0); 2256ed999f82SChuck Lever } 2257de910bd9SOr Gerlitz mutex_unlock(&conn_id->handler_mutex); 2258a1a733f6SKrishna Kumar 2259f6a9d47aSJason Gunthorpe err_unlock: 2260de910bd9SOr Gerlitz mutex_unlock(&listen_id->handler_mutex); 22610b3ca768SHaggai Eran 22620b3ca768SHaggai Eran net_dev_put: 22630b3ca768SHaggai Eran if (net_dev) 22640b3ca768SHaggai Eran dev_put(net_dev); 22650b3ca768SHaggai Eran 2266e51060f0SSean Hefty return ret; 2267e51060f0SSean Hefty } 2268e51060f0SSean Hefty 2269cf53936fSSean Hefty __be64 rdma_get_service_id(struct rdma_cm_id *id, struct sockaddr *addr) 2270e51060f0SSean Hefty { 2271496ce3ceSSean Hefty if (addr->sa_family == AF_IB) 2272496ce3ceSSean Hefty return ((struct sockaddr_ib *) addr)->sib_sid; 2273496ce3ceSSean Hefty 2274cf53936fSSean Hefty return cpu_to_be64(((u64)id->ps << 16) + be16_to_cpu(cma_port(addr))); 2275e51060f0SSean Hefty } 2276cf53936fSSean Hefty EXPORT_SYMBOL(rdma_get_service_id); 2277e51060f0SSean Hefty 2278411460acSParav Pandit void rdma_read_gids(struct rdma_cm_id *cm_id, union ib_gid *sgid, 2279411460acSParav Pandit union ib_gid *dgid) 2280411460acSParav Pandit { 2281411460acSParav Pandit struct rdma_addr *addr = &cm_id->route.addr; 2282411460acSParav Pandit 2283411460acSParav Pandit if (!cm_id->device) { 2284411460acSParav Pandit if (sgid) 2285411460acSParav Pandit memset(sgid, 0, sizeof(*sgid)); 2286411460acSParav Pandit if (dgid) 2287411460acSParav Pandit memset(dgid, 0, sizeof(*dgid)); 2288411460acSParav Pandit return; 2289411460acSParav Pandit } 2290411460acSParav Pandit 2291411460acSParav Pandit if (rdma_protocol_roce(cm_id->device, cm_id->port_num)) { 2292411460acSParav Pandit if (sgid) 2293411460acSParav Pandit rdma_ip2gid((struct sockaddr *)&addr->src_addr, sgid); 2294411460acSParav Pandit if (dgid) 2295411460acSParav Pandit rdma_ip2gid((struct sockaddr *)&addr->dst_addr, dgid); 2296411460acSParav Pandit } else { 2297411460acSParav Pandit if (sgid) 2298411460acSParav Pandit rdma_addr_get_sgid(&addr->dev_addr, sgid); 2299411460acSParav Pandit if (dgid) 2300411460acSParav Pandit rdma_addr_get_dgid(&addr->dev_addr, dgid); 2301411460acSParav Pandit } 2302411460acSParav Pandit } 2303411460acSParav Pandit EXPORT_SYMBOL(rdma_read_gids); 2304411460acSParav Pandit 230507ebafbaSTom Tucker static int cma_iw_handler(struct iw_cm_id *iw_id, struct iw_cm_event *iw_event) 230607ebafbaSTom Tucker { 230707ebafbaSTom Tucker struct rdma_id_private *id_priv = iw_id->context; 23087582df82SParav Pandit struct rdma_cm_event event = {}; 230907ebafbaSTom Tucker int ret = 0; 231024d44a39SSteve Wise struct sockaddr *laddr = (struct sockaddr *)&iw_event->local_addr; 231124d44a39SSteve Wise struct sockaddr *raddr = (struct sockaddr *)&iw_event->remote_addr; 231207ebafbaSTom Tucker 231337e07cdaSBart Van Assche mutex_lock(&id_priv->handler_mutex); 23142a7cec53SJason Gunthorpe if (READ_ONCE(id_priv->state) != RDMA_CM_CONNECT) 231537e07cdaSBart Van Assche goto out; 231607ebafbaSTom Tucker 231707ebafbaSTom Tucker switch (iw_event->event) { 231807ebafbaSTom Tucker case IW_CM_EVENT_CLOSE: 2319a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_DISCONNECTED; 232007ebafbaSTom Tucker break; 232107ebafbaSTom Tucker case IW_CM_EVENT_CONNECT_REPLY: 232224d44a39SSteve Wise memcpy(cma_src_addr(id_priv), laddr, 232324d44a39SSteve Wise rdma_addr_size(laddr)); 232424d44a39SSteve Wise memcpy(cma_dst_addr(id_priv), raddr, 232524d44a39SSteve Wise rdma_addr_size(raddr)); 2326881a045fSSteve Wise switch (iw_event->status) { 2327881a045fSSteve Wise case 0: 2328a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_ESTABLISHED; 23293ebeebc3SKumar Sanghvi event.param.conn.initiator_depth = iw_event->ird; 23303ebeebc3SKumar Sanghvi event.param.conn.responder_resources = iw_event->ord; 233107ebafbaSTom Tucker break; 2332881a045fSSteve Wise case -ECONNRESET: 2333881a045fSSteve Wise case -ECONNREFUSED: 2334881a045fSSteve Wise event.event = RDMA_CM_EVENT_REJECTED; 2335881a045fSSteve Wise break; 2336881a045fSSteve Wise case -ETIMEDOUT: 2337881a045fSSteve Wise event.event = RDMA_CM_EVENT_UNREACHABLE; 2338881a045fSSteve Wise break; 2339881a045fSSteve Wise default: 2340881a045fSSteve Wise event.event = RDMA_CM_EVENT_CONNECT_ERROR; 2341881a045fSSteve Wise break; 2342881a045fSSteve Wise } 2343881a045fSSteve Wise break; 234407ebafbaSTom Tucker case IW_CM_EVENT_ESTABLISHED: 2345a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_ESTABLISHED; 23463ebeebc3SKumar Sanghvi event.param.conn.initiator_depth = iw_event->ird; 23473ebeebc3SKumar Sanghvi event.param.conn.responder_resources = iw_event->ord; 234807ebafbaSTom Tucker break; 234907ebafbaSTom Tucker default: 2350671a6cc2SLeon Romanovsky goto out; 235107ebafbaSTom Tucker } 235207ebafbaSTom Tucker 2353a1b1b61fSSean Hefty event.status = iw_event->status; 2354a1b1b61fSSean Hefty event.param.conn.private_data = iw_event->private_data; 2355a1b1b61fSSean Hefty event.param.conn.private_data_len = iw_event->private_data_len; 2356ed999f82SChuck Lever ret = cma_cm_event_handler(id_priv, &event); 235707ebafbaSTom Tucker if (ret) { 235807ebafbaSTom Tucker /* Destroy the CM ID by returning a non-zero value. */ 235907ebafbaSTom Tucker id_priv->cm_id.iw = NULL; 2360f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(id_priv); 236107ebafbaSTom Tucker return ret; 236207ebafbaSTom Tucker } 236307ebafbaSTom Tucker 236437e07cdaSBart Van Assche out: 2365de910bd9SOr Gerlitz mutex_unlock(&id_priv->handler_mutex); 236607ebafbaSTom Tucker return ret; 236707ebafbaSTom Tucker } 236807ebafbaSTom Tucker 236907ebafbaSTom Tucker static int iw_conn_req_handler(struct iw_cm_id *cm_id, 237007ebafbaSTom Tucker struct iw_cm_event *iw_event) 237107ebafbaSTom Tucker { 237207ebafbaSTom Tucker struct rdma_id_private *listen_id, *conn_id; 23737582df82SParav Pandit struct rdma_cm_event event = {}; 237437e07cdaSBart Van Assche int ret = -ECONNABORTED; 237524d44a39SSteve Wise struct sockaddr *laddr = (struct sockaddr *)&iw_event->local_addr; 237624d44a39SSteve Wise struct sockaddr *raddr = (struct sockaddr *)&iw_event->remote_addr; 237707ebafbaSTom Tucker 23787582df82SParav Pandit event.event = RDMA_CM_EVENT_CONNECT_REQUEST; 23797582df82SParav Pandit event.param.conn.private_data = iw_event->private_data; 23807582df82SParav Pandit event.param.conn.private_data_len = iw_event->private_data_len; 23817582df82SParav Pandit event.param.conn.initiator_depth = iw_event->ird; 23827582df82SParav Pandit event.param.conn.responder_resources = iw_event->ord; 23837582df82SParav Pandit 238407ebafbaSTom Tucker listen_id = cm_id->context; 238537e07cdaSBart Van Assche 238637e07cdaSBart Van Assche mutex_lock(&listen_id->handler_mutex); 2387d490ee52SJason Gunthorpe if (READ_ONCE(listen_id->state) != RDMA_CM_LISTEN) 238837e07cdaSBart Van Assche goto out; 238907ebafbaSTom Tucker 239007ebafbaSTom Tucker /* Create a new RDMA id for the new IW CM ID */ 2391b09c4d70SLeon Romanovsky conn_id = __rdma_create_id(listen_id->id.route.addr.dev_addr.net, 2392fa20105eSGuy Shapiro listen_id->id.event_handler, 2393b09c4d70SLeon Romanovsky listen_id->id.context, RDMA_PS_TCP, 2394b09c4d70SLeon Romanovsky IB_QPT_RC, listen_id); 2395b09c4d70SLeon Romanovsky if (IS_ERR(conn_id)) { 239607ebafbaSTom Tucker ret = -ENOMEM; 239707ebafbaSTom Tucker goto out; 239807ebafbaSTom Tucker } 2399de910bd9SOr Gerlitz mutex_lock_nested(&conn_id->handler_mutex, SINGLE_DEPTH_NESTING); 2400550e5ca7SNir Muchtar conn_id->state = RDMA_CM_CONNECT; 240107ebafbaSTom Tucker 2402575c7e58SParav Pandit ret = rdma_translate_ip(laddr, &conn_id->id.route.addr.dev_addr); 240307ebafbaSTom Tucker if (ret) { 2404f6a9d47aSJason Gunthorpe mutex_unlock(&listen_id->handler_mutex); 2405f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(conn_id); 2406f6a9d47aSJason Gunthorpe return ret; 240707ebafbaSTom Tucker } 240807ebafbaSTom Tucker 240941ab1cb7SParav Pandit ret = cma_iw_acquire_dev(conn_id, listen_id); 241007ebafbaSTom Tucker if (ret) { 2411f6a9d47aSJason Gunthorpe mutex_unlock(&listen_id->handler_mutex); 2412f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(conn_id); 2413f6a9d47aSJason Gunthorpe return ret; 241407ebafbaSTom Tucker } 241507ebafbaSTom Tucker 241607ebafbaSTom Tucker conn_id->cm_id.iw = cm_id; 241707ebafbaSTom Tucker cm_id->context = conn_id; 241807ebafbaSTom Tucker cm_id->cm_handler = cma_iw_handler; 241907ebafbaSTom Tucker 242024d44a39SSteve Wise memcpy(cma_src_addr(conn_id), laddr, rdma_addr_size(laddr)); 242124d44a39SSteve Wise memcpy(cma_dst_addr(conn_id), raddr, rdma_addr_size(raddr)); 242207ebafbaSTom Tucker 2423ed999f82SChuck Lever ret = cma_cm_event_handler(conn_id, &event); 242407ebafbaSTom Tucker if (ret) { 242507ebafbaSTom Tucker /* User wants to destroy the CM ID */ 242607ebafbaSTom Tucker conn_id->cm_id.iw = NULL; 2427b66f31efSBart Van Assche mutex_unlock(&listen_id->handler_mutex); 2428f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(conn_id); 2429b66f31efSBart Van Assche return ret; 243007ebafbaSTom Tucker } 243107ebafbaSTom Tucker 2432de910bd9SOr Gerlitz mutex_unlock(&conn_id->handler_mutex); 2433de910bd9SOr Gerlitz 243407ebafbaSTom Tucker out: 2435de910bd9SOr Gerlitz mutex_unlock(&listen_id->handler_mutex); 243607ebafbaSTom Tucker return ret; 243707ebafbaSTom Tucker } 243807ebafbaSTom Tucker 2439e51060f0SSean Hefty static int cma_ib_listen(struct rdma_id_private *id_priv) 2440e51060f0SSean Hefty { 2441e51060f0SSean Hefty struct sockaddr *addr; 24420c9361fcSJack Morgenstein struct ib_cm_id *id; 2443e51060f0SSean Hefty __be64 svc_id; 2444e51060f0SSean Hefty 2445f4753834SSean Hefty addr = cma_src_addr(id_priv); 2446cf53936fSSean Hefty svc_id = rdma_get_service_id(&id_priv->id, addr); 244785463316SParav Pandit id = ib_cm_insert_listen(id_priv->id.device, 244885463316SParav Pandit cma_ib_req_handler, svc_id); 244951efe394SHaggai Eran if (IS_ERR(id)) 245051efe394SHaggai Eran return PTR_ERR(id); 245151efe394SHaggai Eran id_priv->cm_id.ib = id; 2452e51060f0SSean Hefty 245351efe394SHaggai Eran return 0; 2454e51060f0SSean Hefty } 2455e51060f0SSean Hefty 245607ebafbaSTom Tucker static int cma_iw_listen(struct rdma_id_private *id_priv, int backlog) 245707ebafbaSTom Tucker { 245807ebafbaSTom Tucker int ret; 24590c9361fcSJack Morgenstein struct iw_cm_id *id; 246007ebafbaSTom Tucker 24610c9361fcSJack Morgenstein id = iw_create_cm_id(id_priv->id.device, 246207ebafbaSTom Tucker iw_conn_req_handler, 246307ebafbaSTom Tucker id_priv); 24640c9361fcSJack Morgenstein if (IS_ERR(id)) 24650c9361fcSJack Morgenstein return PTR_ERR(id); 24660c9361fcSJack Morgenstein 246768cdba06SSteve Wise id->tos = id_priv->tos; 2468926ba19bSSteve Wise id->tos_set = id_priv->tos_set; 24690c9361fcSJack Morgenstein id_priv->cm_id.iw = id; 247007ebafbaSTom Tucker 247124d44a39SSteve Wise memcpy(&id_priv->cm_id.iw->local_addr, cma_src_addr(id_priv), 247224d44a39SSteve Wise rdma_addr_size(cma_src_addr(id_priv))); 247307ebafbaSTom Tucker 247407ebafbaSTom Tucker ret = iw_cm_listen(id_priv->cm_id.iw, backlog); 247507ebafbaSTom Tucker 247607ebafbaSTom Tucker if (ret) { 247707ebafbaSTom Tucker iw_destroy_cm_id(id_priv->cm_id.iw); 247807ebafbaSTom Tucker id_priv->cm_id.iw = NULL; 247907ebafbaSTom Tucker } 248007ebafbaSTom Tucker 248107ebafbaSTom Tucker return ret; 248207ebafbaSTom Tucker } 248307ebafbaSTom Tucker 2484e51060f0SSean Hefty static int cma_listen_handler(struct rdma_cm_id *id, 2485e51060f0SSean Hefty struct rdma_cm_event *event) 2486e51060f0SSean Hefty { 2487e51060f0SSean Hefty struct rdma_id_private *id_priv = id->context; 2488e51060f0SSean Hefty 2489d54f23c0SJason Gunthorpe /* Listening IDs are always destroyed on removal */ 2490d54f23c0SJason Gunthorpe if (event->event == RDMA_CM_EVENT_DEVICE_REMOVAL) 2491d54f23c0SJason Gunthorpe return -1; 2492d54f23c0SJason Gunthorpe 2493e51060f0SSean Hefty id->context = id_priv->id.context; 2494e51060f0SSean Hefty id->event_handler = id_priv->id.event_handler; 2495ed999f82SChuck Lever trace_cm_event_handler(id_priv, event); 2496e51060f0SSean Hefty return id_priv->id.event_handler(id, event); 2497e51060f0SSean Hefty } 2498e51060f0SSean Hefty 2499c80a0c52SLeon Romanovsky static int cma_listen_on_dev(struct rdma_id_private *id_priv, 2500dd37d2f5SJason Gunthorpe struct cma_device *cma_dev, 2501dd37d2f5SJason Gunthorpe struct rdma_id_private **to_destroy) 2502e51060f0SSean Hefty { 2503e51060f0SSean Hefty struct rdma_id_private *dev_id_priv; 2504fa20105eSGuy Shapiro struct net *net = id_priv->id.route.addr.dev_addr.net; 2505e51060f0SSean Hefty int ret; 2506e51060f0SSean Hefty 2507730c8912SMark Zhang lockdep_assert_held(&lock); 2508730c8912SMark Zhang 2509dd37d2f5SJason Gunthorpe *to_destroy = NULL; 251072219ceaSMichael Wang if (cma_family(id_priv) == AF_IB && !rdma_cap_ib_cm(cma_dev->device, 1)) 2511c80a0c52SLeon Romanovsky return 0; 251294d0c939SSean Hefty 2513b09c4d70SLeon Romanovsky dev_id_priv = 2514b09c4d70SLeon Romanovsky __rdma_create_id(net, cma_listen_handler, id_priv, 2515b09c4d70SLeon Romanovsky id_priv->id.ps, id_priv->id.qp_type, id_priv); 2516b09c4d70SLeon Romanovsky if (IS_ERR(dev_id_priv)) 2517c80a0c52SLeon Romanovsky return PTR_ERR(dev_id_priv); 2518e51060f0SSean Hefty 2519550e5ca7SNir Muchtar dev_id_priv->state = RDMA_CM_ADDR_BOUND; 2520f4753834SSean Hefty memcpy(cma_src_addr(dev_id_priv), cma_src_addr(id_priv), 2521f4753834SSean Hefty rdma_addr_size(cma_src_addr(id_priv))); 2522e51060f0SSean Hefty 2523045959dbSMatan Barak _cma_attach_to_dev(dev_id_priv, cma_dev); 2524e368d23fSParav Pandit cma_id_get(id_priv); 2525d02d1f53SSean Hefty dev_id_priv->internal_id = 1; 25265b0ec991SSean Hefty dev_id_priv->afonly = id_priv->afonly; 25279491128fSSteve Wise dev_id_priv->tos_set = id_priv->tos_set; 25289491128fSSteve Wise dev_id_priv->tos = id_priv->tos; 2529e51060f0SSean Hefty 2530b09c4d70SLeon Romanovsky ret = rdma_listen(&dev_id_priv->id, id_priv->backlog); 2531e51060f0SSean Hefty if (ret) 2532c80a0c52SLeon Romanovsky goto err_listen; 2533dd37d2f5SJason Gunthorpe list_add_tail(&dev_id_priv->listen_list, &id_priv->listen_list); 2534c80a0c52SLeon Romanovsky return 0; 2535c80a0c52SLeon Romanovsky err_listen: 2536dd37d2f5SJason Gunthorpe /* Caller must destroy this after releasing lock */ 2537dd37d2f5SJason Gunthorpe *to_destroy = dev_id_priv; 2538c80a0c52SLeon Romanovsky dev_warn(&cma_dev->device->dev, "RDMA CMA: %s, error %d\n", __func__, ret); 2539c80a0c52SLeon Romanovsky return ret; 2540e51060f0SSean Hefty } 2541e51060f0SSean Hefty 2542c80a0c52SLeon Romanovsky static int cma_listen_on_all(struct rdma_id_private *id_priv) 2543e51060f0SSean Hefty { 2544dd37d2f5SJason Gunthorpe struct rdma_id_private *to_destroy; 2545e51060f0SSean Hefty struct cma_device *cma_dev; 2546c80a0c52SLeon Romanovsky int ret; 2547e51060f0SSean Hefty 2548e51060f0SSean Hefty mutex_lock(&lock); 2549e51060f0SSean Hefty list_add_tail(&id_priv->list, &listen_any_list); 2550c80a0c52SLeon Romanovsky list_for_each_entry(cma_dev, &dev_list, list) { 2551dd37d2f5SJason Gunthorpe ret = cma_listen_on_dev(id_priv, cma_dev, &to_destroy); 2552dd37d2f5SJason Gunthorpe if (ret) { 2553dd37d2f5SJason Gunthorpe /* Prevent racing with cma_process_remove() */ 2554dd37d2f5SJason Gunthorpe if (to_destroy) 2555dd37d2f5SJason Gunthorpe list_del_init(&to_destroy->list); 2556c80a0c52SLeon Romanovsky goto err_listen; 2557c80a0c52SLeon Romanovsky } 2558dd37d2f5SJason Gunthorpe } 2559e51060f0SSean Hefty mutex_unlock(&lock); 2560c80a0c52SLeon Romanovsky return 0; 2561c80a0c52SLeon Romanovsky 2562c80a0c52SLeon Romanovsky err_listen: 2563c80a0c52SLeon Romanovsky list_del(&id_priv->list); 2564c80a0c52SLeon Romanovsky mutex_unlock(&lock); 2565dd37d2f5SJason Gunthorpe if (to_destroy) 2566dd37d2f5SJason Gunthorpe rdma_destroy_id(&to_destroy->id); 2567c80a0c52SLeon Romanovsky return ret; 2568e51060f0SSean Hefty } 2569e51060f0SSean Hefty 2570a81c994dSSean Hefty void rdma_set_service_type(struct rdma_cm_id *id, int tos) 2571a81c994dSSean Hefty { 2572a81c994dSSean Hefty struct rdma_id_private *id_priv; 2573a81c994dSSean Hefty 2574a81c994dSSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 2575a81c994dSSean Hefty id_priv->tos = (u8) tos; 257689052d78SMajd Dibbiny id_priv->tos_set = true; 2577a81c994dSSean Hefty } 2578a81c994dSSean Hefty EXPORT_SYMBOL(rdma_set_service_type); 2579a81c994dSSean Hefty 25802c1619edSDanit Goldberg /** 25812c1619edSDanit Goldberg * rdma_set_ack_timeout() - Set the ack timeout of QP associated 25822c1619edSDanit Goldberg * with a connection identifier. 25832c1619edSDanit Goldberg * @id: Communication identifier to associated with service type. 25842c1619edSDanit Goldberg * @timeout: Ack timeout to set a QP, expressed as 4.096 * 2^(timeout) usec. 25852c1619edSDanit Goldberg * 25862c1619edSDanit Goldberg * This function should be called before rdma_connect() on active side, 25872c1619edSDanit Goldberg * and on passive side before rdma_accept(). It is applicable to primary 25882c1619edSDanit Goldberg * path only. The timeout will affect the local side of the QP, it is not 2589e1ee1e62SDag Moxnes * negotiated with remote side and zero disables the timer. In case it is 2590e1ee1e62SDag Moxnes * set before rdma_resolve_route, the value will also be used to determine 2591e1ee1e62SDag Moxnes * PacketLifeTime for RoCE. 25922c1619edSDanit Goldberg * 25932c1619edSDanit Goldberg * Return: 0 for success 25942c1619edSDanit Goldberg */ 25952c1619edSDanit Goldberg int rdma_set_ack_timeout(struct rdma_cm_id *id, u8 timeout) 25962c1619edSDanit Goldberg { 25972c1619edSDanit Goldberg struct rdma_id_private *id_priv; 25982c1619edSDanit Goldberg 25992c1619edSDanit Goldberg if (id->qp_type != IB_QPT_RC) 26002c1619edSDanit Goldberg return -EINVAL; 26012c1619edSDanit Goldberg 26022c1619edSDanit Goldberg id_priv = container_of(id, struct rdma_id_private, id); 26032c1619edSDanit Goldberg id_priv->timeout = timeout; 26042c1619edSDanit Goldberg id_priv->timeout_set = true; 26052c1619edSDanit Goldberg 26062c1619edSDanit Goldberg return 0; 26072c1619edSDanit Goldberg } 26082c1619edSDanit Goldberg EXPORT_SYMBOL(rdma_set_ack_timeout); 26092c1619edSDanit Goldberg 2610c2f8fc4eSDasaratharaman Chandramouli static void cma_query_handler(int status, struct sa_path_rec *path_rec, 2611e51060f0SSean Hefty void *context) 2612e51060f0SSean Hefty { 2613e51060f0SSean Hefty struct cma_work *work = context; 2614e51060f0SSean Hefty struct rdma_route *route; 2615e51060f0SSean Hefty 2616e51060f0SSean Hefty route = &work->id->id.route; 2617e51060f0SSean Hefty 2618e51060f0SSean Hefty if (!status) { 2619e51060f0SSean Hefty route->num_paths = 1; 2620e51060f0SSean Hefty *route->path_rec = *path_rec; 2621e51060f0SSean Hefty } else { 2622550e5ca7SNir Muchtar work->old_state = RDMA_CM_ROUTE_QUERY; 2623550e5ca7SNir Muchtar work->new_state = RDMA_CM_ADDR_RESOLVED; 2624e51060f0SSean Hefty work->event.event = RDMA_CM_EVENT_ROUTE_ERROR; 26258f0472d3SSean Hefty work->event.status = status; 2626498683c6SMoni Shoua pr_debug_ratelimited("RDMA CM: ROUTE_ERROR: failed to query path. status %d\n", 2627498683c6SMoni Shoua status); 2628e51060f0SSean Hefty } 2629e51060f0SSean Hefty 2630e51060f0SSean Hefty queue_work(cma_wq, &work->work); 2631e51060f0SSean Hefty } 2632e51060f0SSean Hefty 2633dbace111SLeon Romanovsky static int cma_query_ib_route(struct rdma_id_private *id_priv, 2634dbace111SLeon Romanovsky unsigned long timeout_ms, struct cma_work *work) 2635e51060f0SSean Hefty { 2636f4753834SSean Hefty struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 2637c2f8fc4eSDasaratharaman Chandramouli struct sa_path_rec path_rec; 2638a81c994dSSean Hefty ib_sa_comp_mask comp_mask; 2639a81c994dSSean Hefty struct sockaddr_in6 *sin6; 2640f68194caSSean Hefty struct sockaddr_ib *sib; 2641e51060f0SSean Hefty 2642e51060f0SSean Hefty memset(&path_rec, 0, sizeof path_rec); 26434c33bd19SDasaratharaman Chandramouli 26444c33bd19SDasaratharaman Chandramouli if (rdma_cap_opa_ah(id_priv->id.device, id_priv->id.port_num)) 26454c33bd19SDasaratharaman Chandramouli path_rec.rec_type = SA_PATH_REC_TYPE_OPA; 26464c33bd19SDasaratharaman Chandramouli else 26479fdca4daSDasaratharaman Chandramouli path_rec.rec_type = SA_PATH_REC_TYPE_IB; 2648f4753834SSean Hefty rdma_addr_get_sgid(dev_addr, &path_rec.sgid); 2649f4753834SSean Hefty rdma_addr_get_dgid(dev_addr, &path_rec.dgid); 2650f4753834SSean Hefty path_rec.pkey = cpu_to_be16(ib_addr_get_pkey(dev_addr)); 2651e51060f0SSean Hefty path_rec.numb_path = 1; 2652962063e6SSean Hefty path_rec.reversible = 1; 2653d3957b86SMajd Dibbiny path_rec.service_id = rdma_get_service_id(&id_priv->id, 2654d3957b86SMajd Dibbiny cma_dst_addr(id_priv)); 2655a81c994dSSean Hefty 2656a81c994dSSean Hefty comp_mask = IB_SA_PATH_REC_DGID | IB_SA_PATH_REC_SGID | 2657a81c994dSSean Hefty IB_SA_PATH_REC_PKEY | IB_SA_PATH_REC_NUMB_PATH | 2658a81c994dSSean Hefty IB_SA_PATH_REC_REVERSIBLE | IB_SA_PATH_REC_SERVICE_ID; 2659a81c994dSSean Hefty 2660f68194caSSean Hefty switch (cma_family(id_priv)) { 2661f68194caSSean Hefty case AF_INET: 2662a81c994dSSean Hefty path_rec.qos_class = cpu_to_be16((u16) id_priv->tos); 2663a81c994dSSean Hefty comp_mask |= IB_SA_PATH_REC_QOS_CLASS; 2664f68194caSSean Hefty break; 2665f68194caSSean Hefty case AF_INET6: 2666f4753834SSean Hefty sin6 = (struct sockaddr_in6 *) cma_src_addr(id_priv); 2667a81c994dSSean Hefty path_rec.traffic_class = (u8) (be32_to_cpu(sin6->sin6_flowinfo) >> 20); 2668a81c994dSSean Hefty comp_mask |= IB_SA_PATH_REC_TRAFFIC_CLASS; 2669f68194caSSean Hefty break; 2670f68194caSSean Hefty case AF_IB: 2671f68194caSSean Hefty sib = (struct sockaddr_ib *) cma_src_addr(id_priv); 2672f68194caSSean Hefty path_rec.traffic_class = (u8) (be32_to_cpu(sib->sib_flowinfo) >> 20); 2673f68194caSSean Hefty comp_mask |= IB_SA_PATH_REC_TRAFFIC_CLASS; 2674f68194caSSean Hefty break; 2675a81c994dSSean Hefty } 2676e51060f0SSean Hefty 2677c1a0b23bSMichael S. Tsirkin id_priv->query_id = ib_sa_path_rec_get(&sa_client, id_priv->id.device, 2678e51060f0SSean Hefty id_priv->id.port_num, &path_rec, 2679a81c994dSSean Hefty comp_mask, timeout_ms, 2680a81c994dSSean Hefty GFP_KERNEL, cma_query_handler, 2681a81c994dSSean Hefty work, &id_priv->query); 2682e51060f0SSean Hefty 2683e51060f0SSean Hefty return (id_priv->query_id < 0) ? id_priv->query_id : 0; 2684e51060f0SSean Hefty } 2685e51060f0SSean Hefty 2686c4028958SDavid Howells static void cma_work_handler(struct work_struct *_work) 2687e51060f0SSean Hefty { 2688c4028958SDavid Howells struct cma_work *work = container_of(_work, struct cma_work, work); 2689e51060f0SSean Hefty struct rdma_id_private *id_priv = work->id; 2690e51060f0SSean Hefty 2691de910bd9SOr Gerlitz mutex_lock(&id_priv->handler_mutex); 26927e85bcdaSJason Gunthorpe if (READ_ONCE(id_priv->state) == RDMA_CM_DESTROYING || 26937e85bcdaSJason Gunthorpe READ_ONCE(id_priv->state) == RDMA_CM_DEVICE_REMOVAL) 26947e85bcdaSJason Gunthorpe goto out_unlock; 26957e85bcdaSJason Gunthorpe if (work->old_state != 0 || work->new_state != 0) { 2696e51060f0SSean Hefty if (!cma_comp_exch(id_priv, work->old_state, work->new_state)) 2697f6a9d47aSJason Gunthorpe goto out_unlock; 2698e51060f0SSean Hefty } 2699e51060f0SSean Hefty 2700e51060f0SSean Hefty if (cma_cm_event_handler(id_priv, &work->event)) { 2701e51060f0SSean Hefty cma_id_put(id_priv); 2702e51060f0SSean Hefty destroy_id_handler_unlock(id_priv); 2703e51060f0SSean Hefty goto out_free; 2704e51060f0SSean Hefty } 2705f6a9d47aSJason Gunthorpe 2706f6a9d47aSJason Gunthorpe out_unlock: 2707de910bd9SOr Gerlitz mutex_unlock(&id_priv->handler_mutex); 2708e368d23fSParav Pandit cma_id_put(id_priv); 2709f6a9d47aSJason Gunthorpe out_free: 2710b5de0c60SJason Gunthorpe if (work->event.event == RDMA_CM_EVENT_MULTICAST_JOIN) 2711b5de0c60SJason Gunthorpe rdma_destroy_ah_attr(&work->event.param.ud.ah_attr); 2712dd5bdff8SOr Gerlitz kfree(work); 2713dd5bdff8SOr Gerlitz } 2714dd5bdff8SOr Gerlitz 2715981b5a23SParav Pandit static void cma_init_resolve_route_work(struct cma_work *work, 2716981b5a23SParav Pandit struct rdma_id_private *id_priv) 2717981b5a23SParav Pandit { 2718981b5a23SParav Pandit work->id = id_priv; 2719981b5a23SParav Pandit INIT_WORK(&work->work, cma_work_handler); 2720981b5a23SParav Pandit work->old_state = RDMA_CM_ROUTE_QUERY; 2721981b5a23SParav Pandit work->new_state = RDMA_CM_ROUTE_RESOLVED; 2722981b5a23SParav Pandit work->event.event = RDMA_CM_EVENT_ROUTE_RESOLVED; 2723981b5a23SParav Pandit } 2724981b5a23SParav Pandit 2725081ea519SParav Pandit static void enqueue_resolve_addr_work(struct cma_work *work, 2726981b5a23SParav Pandit struct rdma_id_private *id_priv) 2727981b5a23SParav Pandit { 2728e368d23fSParav Pandit /* Balances with cma_id_put() in cma_work_handler */ 2729e368d23fSParav Pandit cma_id_get(id_priv); 2730081ea519SParav Pandit 2731981b5a23SParav Pandit work->id = id_priv; 2732981b5a23SParav Pandit INIT_WORK(&work->work, cma_work_handler); 2733981b5a23SParav Pandit work->old_state = RDMA_CM_ADDR_QUERY; 2734981b5a23SParav Pandit work->new_state = RDMA_CM_ADDR_RESOLVED; 2735981b5a23SParav Pandit work->event.event = RDMA_CM_EVENT_ADDR_RESOLVED; 2736081ea519SParav Pandit 2737081ea519SParav Pandit queue_work(cma_wq, &work->work); 2738981b5a23SParav Pandit } 2739981b5a23SParav Pandit 2740dbace111SLeon Romanovsky static int cma_resolve_ib_route(struct rdma_id_private *id_priv, 2741dbace111SLeon Romanovsky unsigned long timeout_ms) 2742e51060f0SSean Hefty { 2743e51060f0SSean Hefty struct rdma_route *route = &id_priv->id.route; 2744e51060f0SSean Hefty struct cma_work *work; 2745e51060f0SSean Hefty int ret; 2746e51060f0SSean Hefty 2747e51060f0SSean Hefty work = kzalloc(sizeof *work, GFP_KERNEL); 2748e51060f0SSean Hefty if (!work) 2749e51060f0SSean Hefty return -ENOMEM; 2750e51060f0SSean Hefty 2751981b5a23SParav Pandit cma_init_resolve_route_work(work, id_priv); 2752e51060f0SSean Hefty 2753e51060f0SSean Hefty route->path_rec = kmalloc(sizeof *route->path_rec, GFP_KERNEL); 2754e51060f0SSean Hefty if (!route->path_rec) { 2755e51060f0SSean Hefty ret = -ENOMEM; 2756e51060f0SSean Hefty goto err1; 2757e51060f0SSean Hefty } 2758e51060f0SSean Hefty 2759e51060f0SSean Hefty ret = cma_query_ib_route(id_priv, timeout_ms, work); 2760e51060f0SSean Hefty if (ret) 2761e51060f0SSean Hefty goto err2; 2762e51060f0SSean Hefty 2763e51060f0SSean Hefty return 0; 2764e51060f0SSean Hefty err2: 2765e51060f0SSean Hefty kfree(route->path_rec); 2766e51060f0SSean Hefty route->path_rec = NULL; 2767e51060f0SSean Hefty err1: 2768e51060f0SSean Hefty kfree(work); 2769e51060f0SSean Hefty return ret; 2770e51060f0SSean Hefty } 2771e51060f0SSean Hefty 27729327c7afSParav Pandit static enum ib_gid_type cma_route_gid_type(enum rdma_network_type network_type, 27739327c7afSParav Pandit unsigned long supported_gids, 27749327c7afSParav Pandit enum ib_gid_type default_gid) 27759327c7afSParav Pandit { 27769327c7afSParav Pandit if ((network_type == RDMA_NETWORK_IPV4 || 27779327c7afSParav Pandit network_type == RDMA_NETWORK_IPV6) && 27789327c7afSParav Pandit test_bit(IB_GID_TYPE_ROCE_UDP_ENCAP, &supported_gids)) 27799327c7afSParav Pandit return IB_GID_TYPE_ROCE_UDP_ENCAP; 27809327c7afSParav Pandit 27819327c7afSParav Pandit return default_gid; 27829327c7afSParav Pandit } 27839327c7afSParav Pandit 27849327c7afSParav Pandit /* 27859327c7afSParav Pandit * cma_iboe_set_path_rec_l2_fields() is helper function which sets 27869327c7afSParav Pandit * path record type based on GID type. 27879327c7afSParav Pandit * It also sets up other L2 fields which includes destination mac address 27889327c7afSParav Pandit * netdev ifindex, of the path record. 27899327c7afSParav Pandit * It returns the netdev of the bound interface for this path record entry. 27909327c7afSParav Pandit */ 27919327c7afSParav Pandit static struct net_device * 27929327c7afSParav Pandit cma_iboe_set_path_rec_l2_fields(struct rdma_id_private *id_priv) 27939327c7afSParav Pandit { 27949327c7afSParav Pandit struct rdma_route *route = &id_priv->id.route; 27959327c7afSParav Pandit enum ib_gid_type gid_type = IB_GID_TYPE_ROCE; 27969327c7afSParav Pandit struct rdma_addr *addr = &route->addr; 27979327c7afSParav Pandit unsigned long supported_gids; 27989327c7afSParav Pandit struct net_device *ndev; 27999327c7afSParav Pandit 28009327c7afSParav Pandit if (!addr->dev_addr.bound_dev_if) 28019327c7afSParav Pandit return NULL; 28029327c7afSParav Pandit 28039327c7afSParav Pandit ndev = dev_get_by_index(addr->dev_addr.net, 28049327c7afSParav Pandit addr->dev_addr.bound_dev_if); 28059327c7afSParav Pandit if (!ndev) 28069327c7afSParav Pandit return NULL; 28079327c7afSParav Pandit 28089327c7afSParav Pandit supported_gids = roce_gid_type_mask_support(id_priv->id.device, 28099327c7afSParav Pandit id_priv->id.port_num); 28109327c7afSParav Pandit gid_type = cma_route_gid_type(addr->dev_addr.network, 28119327c7afSParav Pandit supported_gids, 28129327c7afSParav Pandit id_priv->gid_type); 28139327c7afSParav Pandit /* Use the hint from IP Stack to select GID Type */ 28149327c7afSParav Pandit if (gid_type < ib_network_to_gid_type(addr->dev_addr.network)) 28159327c7afSParav Pandit gid_type = ib_network_to_gid_type(addr->dev_addr.network); 28169327c7afSParav Pandit route->path_rec->rec_type = sa_conv_gid_to_pathrec_type(gid_type); 28179327c7afSParav Pandit 2818114cc9c4SParav Pandit route->path_rec->roce.route_resolved = true; 28199327c7afSParav Pandit sa_path_set_dmac(route->path_rec, addr->dev_addr.dst_dev_addr); 28209327c7afSParav Pandit return ndev; 28219327c7afSParav Pandit } 28229327c7afSParav Pandit 2823fe75889fSParav Pandit int rdma_set_ib_path(struct rdma_cm_id *id, 2824fe75889fSParav Pandit struct sa_path_rec *path_rec) 2825e51060f0SSean Hefty { 2826e51060f0SSean Hefty struct rdma_id_private *id_priv; 28278d20a1f0SParav Pandit struct net_device *ndev; 2828e51060f0SSean Hefty int ret; 2829e51060f0SSean Hefty 2830e51060f0SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 2831550e5ca7SNir Muchtar if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_RESOLVED, 2832550e5ca7SNir Muchtar RDMA_CM_ROUTE_RESOLVED)) 2833e51060f0SSean Hefty return -EINVAL; 2834e51060f0SSean Hefty 2835fe75889fSParav Pandit id->route.path_rec = kmemdup(path_rec, sizeof(*path_rec), 28369893e742SJulia Lawall GFP_KERNEL); 2837e51060f0SSean Hefty if (!id->route.path_rec) { 2838e51060f0SSean Hefty ret = -ENOMEM; 2839e51060f0SSean Hefty goto err; 2840e51060f0SSean Hefty } 2841e51060f0SSean Hefty 28428d20a1f0SParav Pandit if (rdma_protocol_roce(id->device, id->port_num)) { 28438d20a1f0SParav Pandit ndev = cma_iboe_set_path_rec_l2_fields(id_priv); 28448d20a1f0SParav Pandit if (!ndev) { 28458d20a1f0SParav Pandit ret = -ENODEV; 28468d20a1f0SParav Pandit goto err_free; 28478d20a1f0SParav Pandit } 28488d20a1f0SParav Pandit dev_put(ndev); 28498d20a1f0SParav Pandit } 28508d20a1f0SParav Pandit 2851fe75889fSParav Pandit id->route.num_paths = 1; 2852e51060f0SSean Hefty return 0; 28538d20a1f0SParav Pandit 28548d20a1f0SParav Pandit err_free: 28558d20a1f0SParav Pandit kfree(id->route.path_rec); 28568d20a1f0SParav Pandit id->route.path_rec = NULL; 2857e51060f0SSean Hefty err: 2858550e5ca7SNir Muchtar cma_comp_exch(id_priv, RDMA_CM_ROUTE_RESOLVED, RDMA_CM_ADDR_RESOLVED); 2859e51060f0SSean Hefty return ret; 2860e51060f0SSean Hefty } 2861fe75889fSParav Pandit EXPORT_SYMBOL(rdma_set_ib_path); 2862e51060f0SSean Hefty 2863d6f91252SLeon Romanovsky static int cma_resolve_iw_route(struct rdma_id_private *id_priv) 286407ebafbaSTom Tucker { 286507ebafbaSTom Tucker struct cma_work *work; 286607ebafbaSTom Tucker 286707ebafbaSTom Tucker work = kzalloc(sizeof *work, GFP_KERNEL); 286807ebafbaSTom Tucker if (!work) 286907ebafbaSTom Tucker return -ENOMEM; 287007ebafbaSTom Tucker 2871981b5a23SParav Pandit cma_init_resolve_route_work(work, id_priv); 287207ebafbaSTom Tucker queue_work(cma_wq, &work->work); 287307ebafbaSTom Tucker return 0; 287407ebafbaSTom Tucker } 287507ebafbaSTom Tucker 2876d3bd9396SParav Pandit static int get_vlan_ndev_tc(struct net_device *vlan_ndev, int prio) 2877eb072c4bSEyal Perry { 2878eb072c4bSEyal Perry struct net_device *dev; 2879eb072c4bSEyal Perry 2880d3bd9396SParav Pandit dev = vlan_dev_real_dev(vlan_ndev); 2881eb072c4bSEyal Perry if (dev->num_tc) 2882eb072c4bSEyal Perry return netdev_get_prio_tc_map(dev, prio); 2883eb072c4bSEyal Perry 2884d3bd9396SParav Pandit return (vlan_dev_get_egress_qos_mask(vlan_ndev, prio) & 2885eb072c4bSEyal Perry VLAN_PRIO_MASK) >> VLAN_PRIO_SHIFT; 2886d3bd9396SParav Pandit } 2887d3bd9396SParav Pandit 2888d3bd9396SParav Pandit struct iboe_prio_tc_map { 2889d3bd9396SParav Pandit int input_prio; 2890d3bd9396SParav Pandit int output_tc; 2891d3bd9396SParav Pandit bool found; 2892d3bd9396SParav Pandit }; 2893d3bd9396SParav Pandit 2894eff74233STaehee Yoo static int get_lower_vlan_dev_tc(struct net_device *dev, 2895eff74233STaehee Yoo struct netdev_nested_priv *priv) 2896d3bd9396SParav Pandit { 2897eff74233STaehee Yoo struct iboe_prio_tc_map *map = (struct iboe_prio_tc_map *)priv->data; 2898d3bd9396SParav Pandit 2899d3bd9396SParav Pandit if (is_vlan_dev(dev)) 2900d3bd9396SParav Pandit map->output_tc = get_vlan_ndev_tc(dev, map->input_prio); 2901d3bd9396SParav Pandit else if (dev->num_tc) 2902d3bd9396SParav Pandit map->output_tc = netdev_get_prio_tc_map(dev, map->input_prio); 2903d3bd9396SParav Pandit else 2904d3bd9396SParav Pandit map->output_tc = 0; 2905d3bd9396SParav Pandit /* We are interested only in first level VLAN device, so always 2906d3bd9396SParav Pandit * return 1 to stop iterating over next level devices. 2907d3bd9396SParav Pandit */ 2908d3bd9396SParav Pandit map->found = true; 2909d3bd9396SParav Pandit return 1; 2910d3bd9396SParav Pandit } 2911d3bd9396SParav Pandit 2912d3bd9396SParav Pandit static int iboe_tos_to_sl(struct net_device *ndev, int tos) 2913d3bd9396SParav Pandit { 2914d3bd9396SParav Pandit struct iboe_prio_tc_map prio_tc_map = {}; 2915d3bd9396SParav Pandit int prio = rt_tos2priority(tos); 2916eff74233STaehee Yoo struct netdev_nested_priv priv; 2917d3bd9396SParav Pandit 2918d3bd9396SParav Pandit /* If VLAN device, get it directly from the VLAN netdev */ 2919d3bd9396SParav Pandit if (is_vlan_dev(ndev)) 2920d3bd9396SParav Pandit return get_vlan_ndev_tc(ndev, prio); 2921d3bd9396SParav Pandit 2922d3bd9396SParav Pandit prio_tc_map.input_prio = prio; 2923eff74233STaehee Yoo priv.data = (void *)&prio_tc_map; 2924d3bd9396SParav Pandit rcu_read_lock(); 2925d3bd9396SParav Pandit netdev_walk_all_lower_dev_rcu(ndev, 2926d3bd9396SParav Pandit get_lower_vlan_dev_tc, 2927eff74233STaehee Yoo &priv); 2928d3bd9396SParav Pandit rcu_read_unlock(); 2929d3bd9396SParav Pandit /* If map is found from lower device, use it; Otherwise 2930d3bd9396SParav Pandit * continue with the current netdevice to get priority to tc map. 2931d3bd9396SParav Pandit */ 2932d3bd9396SParav Pandit if (prio_tc_map.found) 2933d3bd9396SParav Pandit return prio_tc_map.output_tc; 2934d3bd9396SParav Pandit else if (ndev->num_tc) 2935d3bd9396SParav Pandit return netdev_get_prio_tc_map(ndev, prio); 2936d3bd9396SParav Pandit else 2937eb072c4bSEyal Perry return 0; 2938eb072c4bSEyal Perry } 2939eb072c4bSEyal Perry 2940f6653405SMark Zhang static __be32 cma_get_roce_udp_flow_label(struct rdma_id_private *id_priv) 2941f6653405SMark Zhang { 2942f6653405SMark Zhang struct sockaddr_in6 *addr6; 2943f6653405SMark Zhang u16 dport, sport; 2944f6653405SMark Zhang u32 hash, fl; 2945f6653405SMark Zhang 2946f6653405SMark Zhang addr6 = (struct sockaddr_in6 *)cma_src_addr(id_priv); 2947f6653405SMark Zhang fl = be32_to_cpu(addr6->sin6_flowinfo) & IB_GRH_FLOWLABEL_MASK; 2948f6653405SMark Zhang if ((cma_family(id_priv) != AF_INET6) || !fl) { 2949f6653405SMark Zhang dport = be16_to_cpu(cma_port(cma_dst_addr(id_priv))); 2950f6653405SMark Zhang sport = be16_to_cpu(cma_port(cma_src_addr(id_priv))); 2951f6653405SMark Zhang hash = (u32)sport * 31 + dport; 2952f6653405SMark Zhang fl = hash & IB_GRH_FLOWLABEL_MASK; 2953f6653405SMark Zhang } 2954f6653405SMark Zhang 2955f6653405SMark Zhang return cpu_to_be32(fl); 2956f6653405SMark Zhang } 2957f6653405SMark Zhang 29583c86aa70SEli Cohen static int cma_resolve_iboe_route(struct rdma_id_private *id_priv) 29593c86aa70SEli Cohen { 29603c86aa70SEli Cohen struct rdma_route *route = &id_priv->id.route; 29613c86aa70SEli Cohen struct rdma_addr *addr = &route->addr; 29623c86aa70SEli Cohen struct cma_work *work; 29633c86aa70SEli Cohen int ret; 29644367ec7fSParav Pandit struct net_device *ndev; 29654367ec7fSParav Pandit 296689052d78SMajd Dibbiny u8 default_roce_tos = id_priv->cma_dev->default_roce_tos[id_priv->id.port_num - 296789052d78SMajd Dibbiny rdma_start_port(id_priv->cma_dev->device)]; 296889052d78SMajd Dibbiny u8 tos = id_priv->tos_set ? id_priv->tos : default_roce_tos; 2969dd5f03beSMatan Barak 29703c86aa70SEli Cohen 29713c86aa70SEli Cohen work = kzalloc(sizeof *work, GFP_KERNEL); 29723c86aa70SEli Cohen if (!work) 29733c86aa70SEli Cohen return -ENOMEM; 29743c86aa70SEli Cohen 29753c86aa70SEli Cohen route->path_rec = kzalloc(sizeof *route->path_rec, GFP_KERNEL); 29763c86aa70SEli Cohen if (!route->path_rec) { 29773c86aa70SEli Cohen ret = -ENOMEM; 29783c86aa70SEli Cohen goto err1; 29793c86aa70SEli Cohen } 29803c86aa70SEli Cohen 29813c86aa70SEli Cohen route->num_paths = 1; 29823c86aa70SEli Cohen 29839327c7afSParav Pandit ndev = cma_iboe_set_path_rec_l2_fields(id_priv); 298423d70503SWei Yongjun if (!ndev) { 298523d70503SWei Yongjun ret = -ENODEV; 298623d70503SWei Yongjun goto err2; 298723d70503SWei Yongjun } 298820029832SMatan Barak 29897b85627bSMoni Shoua rdma_ip2gid((struct sockaddr *)&id_priv->id.route.addr.src_addr, 29907b85627bSMoni Shoua &route->path_rec->sgid); 29917b85627bSMoni Shoua rdma_ip2gid((struct sockaddr *)&id_priv->id.route.addr.dst_addr, 29927b85627bSMoni Shoua &route->path_rec->dgid); 2993af7bd463SEli Cohen 2994c3efe750SMatan Barak if (((struct sockaddr *)&id_priv->id.route.addr.dst_addr)->sa_family != AF_IB) 2995c865f246SSomnath Kotur /* TODO: get the hoplimit from the inet/inet6 device */ 2996c3efe750SMatan Barak route->path_rec->hop_limit = addr->dev_addr.hoplimit; 2997c3efe750SMatan Barak else 2998af7bd463SEli Cohen route->path_rec->hop_limit = 1; 2999af7bd463SEli Cohen route->path_rec->reversible = 1; 3000af7bd463SEli Cohen route->path_rec->pkey = cpu_to_be16(0xffff); 3001af7bd463SEli Cohen route->path_rec->mtu_selector = IB_SA_EQ; 300289052d78SMajd Dibbiny route->path_rec->sl = iboe_tos_to_sl(ndev, tos); 300389052d78SMajd Dibbiny route->path_rec->traffic_class = tos; 30043c86aa70SEli Cohen route->path_rec->mtu = iboe_get_mtu(ndev->mtu); 30053c86aa70SEli Cohen route->path_rec->rate_selector = IB_SA_EQ; 30063c86aa70SEli Cohen route->path_rec->rate = iboe_get_rate(ndev); 30073c86aa70SEli Cohen dev_put(ndev); 30083c86aa70SEli Cohen route->path_rec->packet_life_time_selector = IB_SA_EQ; 3009e1ee1e62SDag Moxnes /* In case ACK timeout is set, use this value to calculate 3010e1ee1e62SDag Moxnes * PacketLifeTime. As per IBTA 12.7.34, 3011e1ee1e62SDag Moxnes * local ACK timeout = (2 * PacketLifeTime + Local CA’s ACK delay). 3012e1ee1e62SDag Moxnes * Assuming a negligible local ACK delay, we can use 3013e1ee1e62SDag Moxnes * PacketLifeTime = local ACK timeout/2 3014e1ee1e62SDag Moxnes * as a reasonable approximation for RoCE networks. 3015e1ee1e62SDag Moxnes */ 3016e1ee1e62SDag Moxnes route->path_rec->packet_life_time = id_priv->timeout_set ? 3017e1ee1e62SDag Moxnes id_priv->timeout - 1 : CMA_IBOE_PACKET_LIFETIME; 3018e1ee1e62SDag Moxnes 30193c86aa70SEli Cohen if (!route->path_rec->mtu) { 30203c86aa70SEli Cohen ret = -EINVAL; 30213c86aa70SEli Cohen goto err2; 30223c86aa70SEli Cohen } 30233c86aa70SEli Cohen 3024f6653405SMark Zhang if (rdma_protocol_roce_udp_encap(id_priv->id.device, 3025f6653405SMark Zhang id_priv->id.port_num)) 3026f6653405SMark Zhang route->path_rec->flow_label = 3027f6653405SMark Zhang cma_get_roce_udp_flow_label(id_priv); 3028f6653405SMark Zhang 3029981b5a23SParav Pandit cma_init_resolve_route_work(work, id_priv); 30303c86aa70SEli Cohen queue_work(cma_wq, &work->work); 30313c86aa70SEli Cohen 30323c86aa70SEli Cohen return 0; 30333c86aa70SEli Cohen 30343c86aa70SEli Cohen err2: 30353c86aa70SEli Cohen kfree(route->path_rec); 30363c86aa70SEli Cohen route->path_rec = NULL; 3037987914abSAvihai Horon route->num_paths = 0; 30383c86aa70SEli Cohen err1: 30393c86aa70SEli Cohen kfree(work); 30403c86aa70SEli Cohen return ret; 30413c86aa70SEli Cohen } 30423c86aa70SEli Cohen 3043dbace111SLeon Romanovsky int rdma_resolve_route(struct rdma_cm_id *id, unsigned long timeout_ms) 3044e51060f0SSean Hefty { 3045e51060f0SSean Hefty struct rdma_id_private *id_priv; 3046e51060f0SSean Hefty int ret; 3047e51060f0SSean Hefty 3048e51060f0SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 3049550e5ca7SNir Muchtar if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_RESOLVED, RDMA_CM_ROUTE_QUERY)) 3050e51060f0SSean Hefty return -EINVAL; 3051e51060f0SSean Hefty 3052e368d23fSParav Pandit cma_id_get(id_priv); 3053fe53ba2fSMichael Wang if (rdma_cap_ib_sa(id->device, id->port_num)) 3054e51060f0SSean Hefty ret = cma_resolve_ib_route(id_priv, timeout_ms); 30555d9fb044SIra Weiny else if (rdma_protocol_roce(id->device, id->port_num)) 30563c86aa70SEli Cohen ret = cma_resolve_iboe_route(id_priv); 3057c72f2189SMichael Wang else if (rdma_protocol_iwarp(id->device, id->port_num)) 3058d6f91252SLeon Romanovsky ret = cma_resolve_iw_route(id_priv); 3059c72f2189SMichael Wang else 3060e51060f0SSean Hefty ret = -ENOSYS; 3061c72f2189SMichael Wang 3062e51060f0SSean Hefty if (ret) 3063e51060f0SSean Hefty goto err; 3064e51060f0SSean Hefty 3065e51060f0SSean Hefty return 0; 3066e51060f0SSean Hefty err: 3067550e5ca7SNir Muchtar cma_comp_exch(id_priv, RDMA_CM_ROUTE_QUERY, RDMA_CM_ADDR_RESOLVED); 3068e368d23fSParav Pandit cma_id_put(id_priv); 3069e51060f0SSean Hefty return ret; 3070e51060f0SSean Hefty } 3071e51060f0SSean Hefty EXPORT_SYMBOL(rdma_resolve_route); 3072e51060f0SSean Hefty 30736a3e362dSSean Hefty static void cma_set_loopback(struct sockaddr *addr) 30746a3e362dSSean Hefty { 30756a3e362dSSean Hefty switch (addr->sa_family) { 30766a3e362dSSean Hefty case AF_INET: 30776a3e362dSSean Hefty ((struct sockaddr_in *) addr)->sin_addr.s_addr = htonl(INADDR_LOOPBACK); 30786a3e362dSSean Hefty break; 30796a3e362dSSean Hefty case AF_INET6: 30806a3e362dSSean Hefty ipv6_addr_set(&((struct sockaddr_in6 *) addr)->sin6_addr, 30816a3e362dSSean Hefty 0, 0, 0, htonl(1)); 30826a3e362dSSean Hefty break; 30836a3e362dSSean Hefty default: 30846a3e362dSSean Hefty ib_addr_set(&((struct sockaddr_ib *) addr)->sib_addr, 30856a3e362dSSean Hefty 0, 0, 0, htonl(1)); 30866a3e362dSSean Hefty break; 30876a3e362dSSean Hefty } 30886a3e362dSSean Hefty } 30896a3e362dSSean Hefty 3090e51060f0SSean Hefty static int cma_bind_loopback(struct rdma_id_private *id_priv) 3091e51060f0SSean Hefty { 3092b0569e40SSean Hefty struct cma_device *cma_dev, *cur_dev; 3093f0ee3404SMichael S. Tsirkin union ib_gid gid; 3094102c5ce0SJack Wang enum ib_port_state port_state; 3095cc055dd3SParav Pandit unsigned int p; 3096e51060f0SSean Hefty u16 pkey; 3097e51060f0SSean Hefty int ret; 3098e51060f0SSean Hefty 3099b0569e40SSean Hefty cma_dev = NULL; 3100e51060f0SSean Hefty mutex_lock(&lock); 3101b0569e40SSean Hefty list_for_each_entry(cur_dev, &dev_list, list) { 3102b0569e40SSean Hefty if (cma_family(id_priv) == AF_IB && 310372219ceaSMichael Wang !rdma_cap_ib_cm(cur_dev->device, 1)) 3104b0569e40SSean Hefty continue; 3105b0569e40SSean Hefty 3106b0569e40SSean Hefty if (!cma_dev) 3107b0569e40SSean Hefty cma_dev = cur_dev; 3108b0569e40SSean Hefty 3109cc055dd3SParav Pandit rdma_for_each_port (cur_dev->device, p) { 3110102c5ce0SJack Wang if (!ib_get_cached_port_state(cur_dev->device, p, &port_state) && 3111102c5ce0SJack Wang port_state == IB_PORT_ACTIVE) { 3112b0569e40SSean Hefty cma_dev = cur_dev; 3113b0569e40SSean Hefty goto port_found; 3114b0569e40SSean Hefty } 3115b0569e40SSean Hefty } 3116b0569e40SSean Hefty } 3117b0569e40SSean Hefty 3118b0569e40SSean Hefty if (!cma_dev) { 3119e82153b5SKrishna Kumar ret = -ENODEV; 3120e82153b5SKrishna Kumar goto out; 3121e82153b5SKrishna Kumar } 3122e51060f0SSean Hefty 3123e51060f0SSean Hefty p = 1; 3124e51060f0SSean Hefty 3125e51060f0SSean Hefty port_found: 31261dfce294SParav Pandit ret = rdma_query_gid(cma_dev->device, p, 0, &gid); 3127e51060f0SSean Hefty if (ret) 3128e51060f0SSean Hefty goto out; 3129e51060f0SSean Hefty 3130e51060f0SSean Hefty ret = ib_get_cached_pkey(cma_dev->device, p, 0, &pkey); 3131e51060f0SSean Hefty if (ret) 3132e51060f0SSean Hefty goto out; 3133e51060f0SSean Hefty 31346f8372b6SSean Hefty id_priv->id.route.addr.dev_addr.dev_type = 313521655afcSMichael Wang (rdma_protocol_ib(cma_dev->device, p)) ? 31366f8372b6SSean Hefty ARPHRD_INFINIBAND : ARPHRD_ETHER; 31376f8372b6SSean Hefty 31386f8372b6SSean Hefty rdma_addr_set_sgid(&id_priv->id.route.addr.dev_addr, &gid); 3139e51060f0SSean Hefty ib_addr_set_pkey(&id_priv->id.route.addr.dev_addr, pkey); 3140e51060f0SSean Hefty id_priv->id.port_num = p; 3141e51060f0SSean Hefty cma_attach_to_dev(id_priv, cma_dev); 3142f4753834SSean Hefty cma_set_loopback(cma_src_addr(id_priv)); 3143e51060f0SSean Hefty out: 3144e51060f0SSean Hefty mutex_unlock(&lock); 3145e51060f0SSean Hefty return ret; 3146e51060f0SSean Hefty } 3147e51060f0SSean Hefty 3148e51060f0SSean Hefty static void addr_handler(int status, struct sockaddr *src_addr, 3149e51060f0SSean Hefty struct rdma_dev_addr *dev_addr, void *context) 3150e51060f0SSean Hefty { 3151e51060f0SSean Hefty struct rdma_id_private *id_priv = context; 31527582df82SParav Pandit struct rdma_cm_event event = {}; 31535fc01fb8SMyungho Jung struct sockaddr *addr; 31545fc01fb8SMyungho Jung struct sockaddr_storage old_addr; 3155e51060f0SSean Hefty 3156de910bd9SOr Gerlitz mutex_lock(&id_priv->handler_mutex); 3157550e5ca7SNir Muchtar if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_QUERY, 3158550e5ca7SNir Muchtar RDMA_CM_ADDR_RESOLVED)) 315961a73c70SSean Hefty goto out; 316061a73c70SSean Hefty 31615fc01fb8SMyungho Jung /* 31625fc01fb8SMyungho Jung * Store the previous src address, so that if we fail to acquire 31635fc01fb8SMyungho Jung * matching rdma device, old address can be restored back, which helps 31645fc01fb8SMyungho Jung * to cancel the cma listen operation correctly. 31655fc01fb8SMyungho Jung */ 31665fc01fb8SMyungho Jung addr = cma_src_addr(id_priv); 31675fc01fb8SMyungho Jung memcpy(&old_addr, addr, rdma_addr_size(addr)); 31685fc01fb8SMyungho Jung memcpy(addr, src_addr, rdma_addr_size(src_addr)); 3169498683c6SMoni Shoua if (!status && !id_priv->cma_dev) { 3170ff11c6cdSParav Pandit status = cma_acquire_dev_by_src_ip(id_priv); 3171498683c6SMoni Shoua if (status) 3172498683c6SMoni Shoua pr_debug_ratelimited("RDMA CM: ADDR_ERROR: failed to acquire device. status %d\n", 3173498683c6SMoni Shoua status); 3174a6e4d254SHåkon Bugge } else if (status) { 3175498683c6SMoni Shoua pr_debug_ratelimited("RDMA CM: ADDR_ERROR: failed to resolve IP. status %d\n", status); 3176498683c6SMoni Shoua } 3177e51060f0SSean Hefty 3178e51060f0SSean Hefty if (status) { 31795fc01fb8SMyungho Jung memcpy(addr, &old_addr, 31805fc01fb8SMyungho Jung rdma_addr_size((struct sockaddr *)&old_addr)); 3181550e5ca7SNir Muchtar if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_RESOLVED, 3182550e5ca7SNir Muchtar RDMA_CM_ADDR_BOUND)) 3183e51060f0SSean Hefty goto out; 3184a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_ADDR_ERROR; 3185a1b1b61fSSean Hefty event.status = status; 31867b85627bSMoni Shoua } else 3187a1b1b61fSSean Hefty event.event = RDMA_CM_EVENT_ADDR_RESOLVED; 3188e51060f0SSean Hefty 3189ed999f82SChuck Lever if (cma_cm_event_handler(id_priv, &event)) { 3190f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(id_priv); 3191e51060f0SSean Hefty return; 3192e51060f0SSean Hefty } 3193e51060f0SSean Hefty out: 3194de910bd9SOr Gerlitz mutex_unlock(&id_priv->handler_mutex); 3195e51060f0SSean Hefty } 3196e51060f0SSean Hefty 3197e51060f0SSean Hefty static int cma_resolve_loopback(struct rdma_id_private *id_priv) 3198e51060f0SSean Hefty { 3199e51060f0SSean Hefty struct cma_work *work; 3200f0ee3404SMichael S. Tsirkin union ib_gid gid; 3201e51060f0SSean Hefty int ret; 3202e51060f0SSean Hefty 3203e51060f0SSean Hefty work = kzalloc(sizeof *work, GFP_KERNEL); 3204e51060f0SSean Hefty if (!work) 3205e51060f0SSean Hefty return -ENOMEM; 3206e51060f0SSean Hefty 3207e51060f0SSean Hefty if (!id_priv->cma_dev) { 3208e51060f0SSean Hefty ret = cma_bind_loopback(id_priv); 3209e51060f0SSean Hefty if (ret) 3210e51060f0SSean Hefty goto err; 3211e51060f0SSean Hefty } 3212e51060f0SSean Hefty 32136f8372b6SSean Hefty rdma_addr_get_sgid(&id_priv->id.route.addr.dev_addr, &gid); 32146f8372b6SSean Hefty rdma_addr_set_dgid(&id_priv->id.route.addr.dev_addr, &gid); 3215e51060f0SSean Hefty 3216081ea519SParav Pandit enqueue_resolve_addr_work(work, id_priv); 3217e51060f0SSean Hefty return 0; 3218e51060f0SSean Hefty err: 3219e51060f0SSean Hefty kfree(work); 3220e51060f0SSean Hefty return ret; 3221e51060f0SSean Hefty } 3222e51060f0SSean Hefty 3223f17df3b0SSean Hefty static int cma_resolve_ib_addr(struct rdma_id_private *id_priv) 3224f17df3b0SSean Hefty { 3225f17df3b0SSean Hefty struct cma_work *work; 3226f17df3b0SSean Hefty int ret; 3227f17df3b0SSean Hefty 3228f17df3b0SSean Hefty work = kzalloc(sizeof *work, GFP_KERNEL); 3229f17df3b0SSean Hefty if (!work) 3230f17df3b0SSean Hefty return -ENOMEM; 3231f17df3b0SSean Hefty 3232f17df3b0SSean Hefty if (!id_priv->cma_dev) { 3233f17df3b0SSean Hefty ret = cma_resolve_ib_dev(id_priv); 3234f17df3b0SSean Hefty if (ret) 3235f17df3b0SSean Hefty goto err; 3236f17df3b0SSean Hefty } 3237f17df3b0SSean Hefty 3238f17df3b0SSean Hefty rdma_addr_set_dgid(&id_priv->id.route.addr.dev_addr, (union ib_gid *) 3239f17df3b0SSean Hefty &(((struct sockaddr_ib *) &id_priv->id.route.addr.dst_addr)->sib_addr)); 3240f17df3b0SSean Hefty 3241081ea519SParav Pandit enqueue_resolve_addr_work(work, id_priv); 3242f17df3b0SSean Hefty return 0; 3243f17df3b0SSean Hefty err: 3244f17df3b0SSean Hefty kfree(work); 3245f17df3b0SSean Hefty return ret; 3246f17df3b0SSean Hefty } 3247f17df3b0SSean Hefty 3248e51060f0SSean Hefty static int cma_bind_addr(struct rdma_cm_id *id, struct sockaddr *src_addr, 32492df7dba8SParav Pandit const struct sockaddr *dst_addr) 3250e51060f0SSean Hefty { 3251d14714dfSSean Hefty if (!src_addr || !src_addr->sa_family) { 3252d14714dfSSean Hefty src_addr = (struct sockaddr *) &id->route.addr.src_addr; 3253f17df3b0SSean Hefty src_addr->sa_family = dst_addr->sa_family; 3254b4cfe397SJack Morgenstein if (IS_ENABLED(CONFIG_IPV6) && 3255b4cfe397SJack Morgenstein dst_addr->sa_family == AF_INET6) { 32566c26a771SSpencer Baugh struct sockaddr_in6 *src_addr6 = (struct sockaddr_in6 *) src_addr; 32576c26a771SSpencer Baugh struct sockaddr_in6 *dst_addr6 = (struct sockaddr_in6 *) dst_addr; 32586c26a771SSpencer Baugh src_addr6->sin6_scope_id = dst_addr6->sin6_scope_id; 32596c26a771SSpencer Baugh if (ipv6_addr_type(&dst_addr6->sin6_addr) & IPV6_ADDR_LINKLOCAL) 32606c26a771SSpencer Baugh id->route.addr.dev_addr.bound_dev_if = dst_addr6->sin6_scope_id; 3261f17df3b0SSean Hefty } else if (dst_addr->sa_family == AF_IB) { 3262f17df3b0SSean Hefty ((struct sockaddr_ib *) src_addr)->sib_pkey = 3263f17df3b0SSean Hefty ((struct sockaddr_ib *) dst_addr)->sib_pkey; 3264d14714dfSSean Hefty } 3265d14714dfSSean Hefty } 3266e51060f0SSean Hefty return rdma_bind_addr(id, src_addr); 3267e51060f0SSean Hefty } 3268e51060f0SSean Hefty 3269732d41c5SJason Gunthorpe /* 3270732d41c5SJason Gunthorpe * If required, resolve the source address for bind and leave the id_priv in 3271732d41c5SJason Gunthorpe * state RDMA_CM_ADDR_BOUND. This oddly uses the state to determine the prior 3272732d41c5SJason Gunthorpe * calls made by ULP, a previously bound ID will not be re-bound and src_addr is 3273732d41c5SJason Gunthorpe * ignored. 3274732d41c5SJason Gunthorpe */ 3275732d41c5SJason Gunthorpe static int resolve_prepare_src(struct rdma_id_private *id_priv, 3276732d41c5SJason Gunthorpe struct sockaddr *src_addr, 3277732d41c5SJason Gunthorpe const struct sockaddr *dst_addr) 3278e51060f0SSean Hefty { 3279e51060f0SSean Hefty int ret; 3280e51060f0SSean Hefty 3281e4103312SParav Pandit memcpy(cma_dst_addr(id_priv), dst_addr, rdma_addr_size(dst_addr)); 3282732d41c5SJason Gunthorpe if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_BOUND, RDMA_CM_ADDR_QUERY)) { 3283732d41c5SJason Gunthorpe /* For a well behaved ULP state will be RDMA_CM_IDLE */ 3284732d41c5SJason Gunthorpe ret = cma_bind_addr(&id_priv->id, src_addr, dst_addr); 3285732d41c5SJason Gunthorpe if (ret) 3286732d41c5SJason Gunthorpe goto err_dst; 3287732d41c5SJason Gunthorpe if (WARN_ON(!cma_comp_exch(id_priv, RDMA_CM_ADDR_BOUND, 3288732d41c5SJason Gunthorpe RDMA_CM_ADDR_QUERY))) { 3289732d41c5SJason Gunthorpe ret = -EINVAL; 3290732d41c5SJason Gunthorpe goto err_dst; 3291e51060f0SSean Hefty } 3292e4103312SParav Pandit } 3293e51060f0SSean Hefty 3294e4103312SParav Pandit if (cma_family(id_priv) != dst_addr->sa_family) { 3295732d41c5SJason Gunthorpe ret = -EINVAL; 3296732d41c5SJason Gunthorpe goto err_state; 3297732d41c5SJason Gunthorpe } 3298732d41c5SJason Gunthorpe return 0; 3299732d41c5SJason Gunthorpe 3300732d41c5SJason Gunthorpe err_state: 3301732d41c5SJason Gunthorpe cma_comp_exch(id_priv, RDMA_CM_ADDR_QUERY, RDMA_CM_ADDR_BOUND); 3302732d41c5SJason Gunthorpe err_dst: 3303e4103312SParav Pandit memset(cma_dst_addr(id_priv), 0, rdma_addr_size(dst_addr)); 3304732d41c5SJason Gunthorpe return ret; 3305e4103312SParav Pandit } 33064ae7152eSSean Hefty 3307732d41c5SJason Gunthorpe int rdma_resolve_addr(struct rdma_cm_id *id, struct sockaddr *src_addr, 3308732d41c5SJason Gunthorpe const struct sockaddr *dst_addr, unsigned long timeout_ms) 3309732d41c5SJason Gunthorpe { 3310732d41c5SJason Gunthorpe struct rdma_id_private *id_priv = 3311732d41c5SJason Gunthorpe container_of(id, struct rdma_id_private, id); 3312732d41c5SJason Gunthorpe int ret; 3313732d41c5SJason Gunthorpe 3314732d41c5SJason Gunthorpe ret = resolve_prepare_src(id_priv, src_addr, dst_addr); 3315732d41c5SJason Gunthorpe if (ret) 3316732d41c5SJason Gunthorpe return ret; 3317e51060f0SSean Hefty 3318f17df3b0SSean Hefty if (cma_any_addr(dst_addr)) { 3319e51060f0SSean Hefty ret = cma_resolve_loopback(id_priv); 3320f17df3b0SSean Hefty } else { 3321f17df3b0SSean Hefty if (dst_addr->sa_family == AF_IB) { 3322f17df3b0SSean Hefty ret = cma_resolve_ib_addr(id_priv); 3323f17df3b0SSean Hefty } else { 33240e9d2c19SParav Pandit ret = rdma_resolve_ip(cma_src_addr(id_priv), dst_addr, 33250e9d2c19SParav Pandit &id->route.addr.dev_addr, 33260e9d2c19SParav Pandit timeout_ms, addr_handler, 33270e9d2c19SParav Pandit false, id_priv); 3328f17df3b0SSean Hefty } 3329f17df3b0SSean Hefty } 3330e51060f0SSean Hefty if (ret) 3331e51060f0SSean Hefty goto err; 3332e51060f0SSean Hefty 3333e51060f0SSean Hefty return 0; 3334e51060f0SSean Hefty err: 3335550e5ca7SNir Muchtar cma_comp_exch(id_priv, RDMA_CM_ADDR_QUERY, RDMA_CM_ADDR_BOUND); 3336e51060f0SSean Hefty return ret; 3337e51060f0SSean Hefty } 3338e51060f0SSean Hefty EXPORT_SYMBOL(rdma_resolve_addr); 3339e51060f0SSean Hefty 3340a9bb7912SHefty, Sean int rdma_set_reuseaddr(struct rdma_cm_id *id, int reuse) 3341a9bb7912SHefty, Sean { 3342a9bb7912SHefty, Sean struct rdma_id_private *id_priv; 3343a9bb7912SHefty, Sean unsigned long flags; 3344a9bb7912SHefty, Sean int ret; 3345a9bb7912SHefty, Sean 3346a9bb7912SHefty, Sean id_priv = container_of(id, struct rdma_id_private, id); 3347a9bb7912SHefty, Sean spin_lock_irqsave(&id_priv->lock, flags); 3348d490ee52SJason Gunthorpe if ((reuse && id_priv->state != RDMA_CM_LISTEN) || 3349d490ee52SJason Gunthorpe id_priv->state == RDMA_CM_IDLE) { 3350a9bb7912SHefty, Sean id_priv->reuseaddr = reuse; 3351a9bb7912SHefty, Sean ret = 0; 3352a9bb7912SHefty, Sean } else { 3353a9bb7912SHefty, Sean ret = -EINVAL; 3354a9bb7912SHefty, Sean } 3355a9bb7912SHefty, Sean spin_unlock_irqrestore(&id_priv->lock, flags); 3356a9bb7912SHefty, Sean return ret; 3357a9bb7912SHefty, Sean } 3358a9bb7912SHefty, Sean EXPORT_SYMBOL(rdma_set_reuseaddr); 3359a9bb7912SHefty, Sean 336068602120SSean Hefty int rdma_set_afonly(struct rdma_cm_id *id, int afonly) 336168602120SSean Hefty { 336268602120SSean Hefty struct rdma_id_private *id_priv; 336368602120SSean Hefty unsigned long flags; 336468602120SSean Hefty int ret; 336568602120SSean Hefty 336668602120SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 336768602120SSean Hefty spin_lock_irqsave(&id_priv->lock, flags); 336868602120SSean Hefty if (id_priv->state == RDMA_CM_IDLE || id_priv->state == RDMA_CM_ADDR_BOUND) { 336968602120SSean Hefty id_priv->options |= (1 << CMA_OPTION_AFONLY); 337068602120SSean Hefty id_priv->afonly = afonly; 337168602120SSean Hefty ret = 0; 337268602120SSean Hefty } else { 337368602120SSean Hefty ret = -EINVAL; 337468602120SSean Hefty } 337568602120SSean Hefty spin_unlock_irqrestore(&id_priv->lock, flags); 337668602120SSean Hefty return ret; 337768602120SSean Hefty } 337868602120SSean Hefty EXPORT_SYMBOL(rdma_set_afonly); 337968602120SSean Hefty 3380e51060f0SSean Hefty static void cma_bind_port(struct rdma_bind_list *bind_list, 3381e51060f0SSean Hefty struct rdma_id_private *id_priv) 3382e51060f0SSean Hefty { 338358afdcb7SSean Hefty struct sockaddr *addr; 338458afdcb7SSean Hefty struct sockaddr_ib *sib; 338558afdcb7SSean Hefty u64 sid, mask; 338658afdcb7SSean Hefty __be16 port; 3387e51060f0SSean Hefty 3388730c8912SMark Zhang lockdep_assert_held(&lock); 3389730c8912SMark Zhang 3390f4753834SSean Hefty addr = cma_src_addr(id_priv); 339158afdcb7SSean Hefty port = htons(bind_list->port); 339258afdcb7SSean Hefty 339358afdcb7SSean Hefty switch (addr->sa_family) { 339458afdcb7SSean Hefty case AF_INET: 339558afdcb7SSean Hefty ((struct sockaddr_in *) addr)->sin_port = port; 339658afdcb7SSean Hefty break; 339758afdcb7SSean Hefty case AF_INET6: 339858afdcb7SSean Hefty ((struct sockaddr_in6 *) addr)->sin6_port = port; 339958afdcb7SSean Hefty break; 340058afdcb7SSean Hefty case AF_IB: 340158afdcb7SSean Hefty sib = (struct sockaddr_ib *) addr; 340258afdcb7SSean Hefty sid = be64_to_cpu(sib->sib_sid); 340358afdcb7SSean Hefty mask = be64_to_cpu(sib->sib_sid_mask); 340458afdcb7SSean Hefty sib->sib_sid = cpu_to_be64((sid & mask) | (u64) ntohs(port)); 340558afdcb7SSean Hefty sib->sib_sid_mask = cpu_to_be64(~0ULL); 340658afdcb7SSean Hefty break; 340758afdcb7SSean Hefty } 3408e51060f0SSean Hefty id_priv->bind_list = bind_list; 3409e51060f0SSean Hefty hlist_add_head(&id_priv->node, &bind_list->owners); 3410e51060f0SSean Hefty } 3411e51060f0SSean Hefty 34122253fc0cSSteve Wise static int cma_alloc_port(enum rdma_ucm_port_space ps, 3413aac978e1SHaggai Eran struct rdma_id_private *id_priv, unsigned short snum) 3414e51060f0SSean Hefty { 3415e51060f0SSean Hefty struct rdma_bind_list *bind_list; 34163b069c5dSTejun Heo int ret; 3417e51060f0SSean Hefty 3418730c8912SMark Zhang lockdep_assert_held(&lock); 3419730c8912SMark Zhang 3420cb164b8cSSean Hefty bind_list = kzalloc(sizeof *bind_list, GFP_KERNEL); 3421e51060f0SSean Hefty if (!bind_list) 3422e51060f0SSean Hefty return -ENOMEM; 3423e51060f0SSean Hefty 3424fa20105eSGuy Shapiro ret = cma_ps_alloc(id_priv->id.route.addr.dev_addr.net, ps, bind_list, 3425fa20105eSGuy Shapiro snum); 34263b069c5dSTejun Heo if (ret < 0) 34273b069c5dSTejun Heo goto err; 3428e51060f0SSean Hefty 3429e51060f0SSean Hefty bind_list->ps = ps; 3430061ccb52SLeon Romanovsky bind_list->port = snum; 3431e51060f0SSean Hefty cma_bind_port(bind_list, id_priv); 3432e51060f0SSean Hefty return 0; 34333b069c5dSTejun Heo err: 3434aedec080SSean Hefty kfree(bind_list); 34353b069c5dSTejun Heo return ret == -ENOSPC ? -EADDRNOTAVAIL : ret; 3436aedec080SSean Hefty } 3437aedec080SSean Hefty 343819b752a1SMoni Shoua static int cma_port_is_unique(struct rdma_bind_list *bind_list, 343919b752a1SMoni Shoua struct rdma_id_private *id_priv) 344019b752a1SMoni Shoua { 344119b752a1SMoni Shoua struct rdma_id_private *cur_id; 344219b752a1SMoni Shoua struct sockaddr *daddr = cma_dst_addr(id_priv); 344319b752a1SMoni Shoua struct sockaddr *saddr = cma_src_addr(id_priv); 344419b752a1SMoni Shoua __be16 dport = cma_port(daddr); 344519b752a1SMoni Shoua 3446730c8912SMark Zhang lockdep_assert_held(&lock); 3447730c8912SMark Zhang 344819b752a1SMoni Shoua hlist_for_each_entry(cur_id, &bind_list->owners, node) { 344919b752a1SMoni Shoua struct sockaddr *cur_daddr = cma_dst_addr(cur_id); 345019b752a1SMoni Shoua struct sockaddr *cur_saddr = cma_src_addr(cur_id); 345119b752a1SMoni Shoua __be16 cur_dport = cma_port(cur_daddr); 345219b752a1SMoni Shoua 345319b752a1SMoni Shoua if (id_priv == cur_id) 345419b752a1SMoni Shoua continue; 345519b752a1SMoni Shoua 345619b752a1SMoni Shoua /* different dest port -> unique */ 34579dea9a2fSTatyana Nikolova if (!cma_any_port(daddr) && 34589dea9a2fSTatyana Nikolova !cma_any_port(cur_daddr) && 345919b752a1SMoni Shoua (dport != cur_dport)) 346019b752a1SMoni Shoua continue; 346119b752a1SMoni Shoua 346219b752a1SMoni Shoua /* different src address -> unique */ 346319b752a1SMoni Shoua if (!cma_any_addr(saddr) && 346419b752a1SMoni Shoua !cma_any_addr(cur_saddr) && 346519b752a1SMoni Shoua cma_addr_cmp(saddr, cur_saddr)) 346619b752a1SMoni Shoua continue; 346719b752a1SMoni Shoua 346819b752a1SMoni Shoua /* different dst address -> unique */ 34699dea9a2fSTatyana Nikolova if (!cma_any_addr(daddr) && 34709dea9a2fSTatyana Nikolova !cma_any_addr(cur_daddr) && 347119b752a1SMoni Shoua cma_addr_cmp(daddr, cur_daddr)) 347219b752a1SMoni Shoua continue; 347319b752a1SMoni Shoua 347419b752a1SMoni Shoua return -EADDRNOTAVAIL; 347519b752a1SMoni Shoua } 347619b752a1SMoni Shoua return 0; 347719b752a1SMoni Shoua } 347819b752a1SMoni Shoua 34792253fc0cSSteve Wise static int cma_alloc_any_port(enum rdma_ucm_port_space ps, 3480aac978e1SHaggai Eran struct rdma_id_private *id_priv) 3481aedec080SSean Hefty { 34825d7220e8STetsuo Handa static unsigned int last_used_port; 34835d7220e8STetsuo Handa int low, high, remaining; 34845d7220e8STetsuo Handa unsigned int rover; 3485fa20105eSGuy Shapiro struct net *net = id_priv->id.route.addr.dev_addr.net; 3486aedec080SSean Hefty 3487730c8912SMark Zhang lockdep_assert_held(&lock); 3488730c8912SMark Zhang 3489fa20105eSGuy Shapiro inet_get_local_port_range(net, &low, &high); 34905d7220e8STetsuo Handa remaining = (high - low) + 1; 349163862b5bSAruna-Hewapathirane rover = prandom_u32() % remaining + low; 34925d7220e8STetsuo Handa retry: 349319b752a1SMoni Shoua if (last_used_port != rover) { 349419b752a1SMoni Shoua struct rdma_bind_list *bind_list; 349519b752a1SMoni Shoua int ret; 349619b752a1SMoni Shoua 349719b752a1SMoni Shoua bind_list = cma_ps_find(net, ps, (unsigned short)rover); 349819b752a1SMoni Shoua 349919b752a1SMoni Shoua if (!bind_list) { 350019b752a1SMoni Shoua ret = cma_alloc_port(ps, id_priv, rover); 350119b752a1SMoni Shoua } else { 350219b752a1SMoni Shoua ret = cma_port_is_unique(bind_list, id_priv); 350319b752a1SMoni Shoua if (!ret) 350419b752a1SMoni Shoua cma_bind_port(bind_list, id_priv); 350519b752a1SMoni Shoua } 35065d7220e8STetsuo Handa /* 35075d7220e8STetsuo Handa * Remember previously used port number in order to avoid 35085d7220e8STetsuo Handa * re-using same port immediately after it is closed. 35095d7220e8STetsuo Handa */ 35105d7220e8STetsuo Handa if (!ret) 35115d7220e8STetsuo Handa last_used_port = rover; 35125d7220e8STetsuo Handa if (ret != -EADDRNOTAVAIL) 35135d7220e8STetsuo Handa return ret; 35145d7220e8STetsuo Handa } 35155d7220e8STetsuo Handa if (--remaining) { 35165d7220e8STetsuo Handa rover++; 35175d7220e8STetsuo Handa if ((rover < low) || (rover > high)) 35185d7220e8STetsuo Handa rover = low; 3519aedec080SSean Hefty goto retry; 3520aedec080SSean Hefty } 35215d7220e8STetsuo Handa return -EADDRNOTAVAIL; 3522e51060f0SSean Hefty } 3523e51060f0SSean Hefty 3524a9bb7912SHefty, Sean /* 3525a9bb7912SHefty, Sean * Check that the requested port is available. This is called when trying to 3526a9bb7912SHefty, Sean * bind to a specific port, or when trying to listen on a bound port. In 3527a9bb7912SHefty, Sean * the latter case, the provided id_priv may already be on the bind_list, but 3528a9bb7912SHefty, Sean * we still need to check that it's okay to start listening. 3529a9bb7912SHefty, Sean */ 3530a9bb7912SHefty, Sean static int cma_check_port(struct rdma_bind_list *bind_list, 3531a9bb7912SHefty, Sean struct rdma_id_private *id_priv, uint8_t reuseaddr) 3532e51060f0SSean Hefty { 3533e51060f0SSean Hefty struct rdma_id_private *cur_id; 353443b752daSHefty, Sean struct sockaddr *addr, *cur_addr; 3535e51060f0SSean Hefty 3536730c8912SMark Zhang lockdep_assert_held(&lock); 3537730c8912SMark Zhang 3538f4753834SSean Hefty addr = cma_src_addr(id_priv); 3539b67bfe0dSSasha Levin hlist_for_each_entry(cur_id, &bind_list->owners, node) { 3540a9bb7912SHefty, Sean if (id_priv == cur_id) 3541a9bb7912SHefty, Sean continue; 3542a9bb7912SHefty, Sean 3543d490ee52SJason Gunthorpe if (reuseaddr && cur_id->reuseaddr) 35445b0ec991SSean Hefty continue; 35455b0ec991SSean Hefty 3546f4753834SSean Hefty cur_addr = cma_src_addr(cur_id); 35475b0ec991SSean Hefty if (id_priv->afonly && cur_id->afonly && 35485b0ec991SSean Hefty (addr->sa_family != cur_addr->sa_family)) 35495b0ec991SSean Hefty continue; 35505b0ec991SSean Hefty 35515b0ec991SSean Hefty if (cma_any_addr(addr) || cma_any_addr(cur_addr)) 3552e51060f0SSean Hefty return -EADDRNOTAVAIL; 3553e51060f0SSean Hefty 355443b752daSHefty, Sean if (!cma_addr_cmp(addr, cur_addr)) 3555e51060f0SSean Hefty return -EADDRINUSE; 3556e51060f0SSean Hefty } 3557e51060f0SSean Hefty return 0; 3558e51060f0SSean Hefty } 3559e51060f0SSean Hefty 35602253fc0cSSteve Wise static int cma_use_port(enum rdma_ucm_port_space ps, 3561aac978e1SHaggai Eran struct rdma_id_private *id_priv) 3562a9bb7912SHefty, Sean { 3563a9bb7912SHefty, Sean struct rdma_bind_list *bind_list; 3564a9bb7912SHefty, Sean unsigned short snum; 3565a9bb7912SHefty, Sean int ret; 3566a9bb7912SHefty, Sean 3567730c8912SMark Zhang lockdep_assert_held(&lock); 3568730c8912SMark Zhang 3569f4753834SSean Hefty snum = ntohs(cma_port(cma_src_addr(id_priv))); 3570a9bb7912SHefty, Sean if (snum < PROT_SOCK && !capable(CAP_NET_BIND_SERVICE)) 3571a9bb7912SHefty, Sean return -EACCES; 3572a9bb7912SHefty, Sean 3573fa20105eSGuy Shapiro bind_list = cma_ps_find(id_priv->id.route.addr.dev_addr.net, ps, snum); 3574a9bb7912SHefty, Sean if (!bind_list) { 3575a9bb7912SHefty, Sean ret = cma_alloc_port(ps, id_priv, snum); 3576a9bb7912SHefty, Sean } else { 3577a9bb7912SHefty, Sean ret = cma_check_port(bind_list, id_priv, id_priv->reuseaddr); 3578a9bb7912SHefty, Sean if (!ret) 3579a9bb7912SHefty, Sean cma_bind_port(bind_list, id_priv); 3580a9bb7912SHefty, Sean } 3581a9bb7912SHefty, Sean return ret; 3582a9bb7912SHefty, Sean } 3583a9bb7912SHefty, Sean 35842253fc0cSSteve Wise static enum rdma_ucm_port_space 35852253fc0cSSteve Wise cma_select_inet_ps(struct rdma_id_private *id_priv) 358658afdcb7SSean Hefty { 358758afdcb7SSean Hefty switch (id_priv->id.ps) { 358858afdcb7SSean Hefty case RDMA_PS_TCP: 358958afdcb7SSean Hefty case RDMA_PS_UDP: 359058afdcb7SSean Hefty case RDMA_PS_IPOIB: 359158afdcb7SSean Hefty case RDMA_PS_IB: 3592aac978e1SHaggai Eran return id_priv->id.ps; 359358afdcb7SSean Hefty default: 3594aac978e1SHaggai Eran 3595aac978e1SHaggai Eran return 0; 359658afdcb7SSean Hefty } 359758afdcb7SSean Hefty } 359858afdcb7SSean Hefty 35992253fc0cSSteve Wise static enum rdma_ucm_port_space 36002253fc0cSSteve Wise cma_select_ib_ps(struct rdma_id_private *id_priv) 360158afdcb7SSean Hefty { 36022253fc0cSSteve Wise enum rdma_ucm_port_space ps = 0; 360358afdcb7SSean Hefty struct sockaddr_ib *sib; 360458afdcb7SSean Hefty u64 sid_ps, mask, sid; 360558afdcb7SSean Hefty 3606f4753834SSean Hefty sib = (struct sockaddr_ib *) cma_src_addr(id_priv); 360758afdcb7SSean Hefty mask = be64_to_cpu(sib->sib_sid_mask) & RDMA_IB_IP_PS_MASK; 360858afdcb7SSean Hefty sid = be64_to_cpu(sib->sib_sid) & mask; 360958afdcb7SSean Hefty 361058afdcb7SSean Hefty if ((id_priv->id.ps == RDMA_PS_IB) && (sid == (RDMA_IB_IP_PS_IB & mask))) { 361158afdcb7SSean Hefty sid_ps = RDMA_IB_IP_PS_IB; 3612aac978e1SHaggai Eran ps = RDMA_PS_IB; 361358afdcb7SSean Hefty } else if (((id_priv->id.ps == RDMA_PS_IB) || (id_priv->id.ps == RDMA_PS_TCP)) && 361458afdcb7SSean Hefty (sid == (RDMA_IB_IP_PS_TCP & mask))) { 361558afdcb7SSean Hefty sid_ps = RDMA_IB_IP_PS_TCP; 3616aac978e1SHaggai Eran ps = RDMA_PS_TCP; 361758afdcb7SSean Hefty } else if (((id_priv->id.ps == RDMA_PS_IB) || (id_priv->id.ps == RDMA_PS_UDP)) && 361858afdcb7SSean Hefty (sid == (RDMA_IB_IP_PS_UDP & mask))) { 361958afdcb7SSean Hefty sid_ps = RDMA_IB_IP_PS_UDP; 3620aac978e1SHaggai Eran ps = RDMA_PS_UDP; 362158afdcb7SSean Hefty } 362258afdcb7SSean Hefty 362358afdcb7SSean Hefty if (ps) { 362458afdcb7SSean Hefty sib->sib_sid = cpu_to_be64(sid_ps | ntohs(cma_port((struct sockaddr *) sib))); 362558afdcb7SSean Hefty sib->sib_sid_mask = cpu_to_be64(RDMA_IB_IP_PS_MASK | 362658afdcb7SSean Hefty be64_to_cpu(sib->sib_sid_mask)); 362758afdcb7SSean Hefty } 362858afdcb7SSean Hefty return ps; 362958afdcb7SSean Hefty } 363058afdcb7SSean Hefty 3631e51060f0SSean Hefty static int cma_get_port(struct rdma_id_private *id_priv) 3632e51060f0SSean Hefty { 36332253fc0cSSteve Wise enum rdma_ucm_port_space ps; 3634e51060f0SSean Hefty int ret; 3635e51060f0SSean Hefty 3636f4753834SSean Hefty if (cma_family(id_priv) != AF_IB) 363758afdcb7SSean Hefty ps = cma_select_inet_ps(id_priv); 363858afdcb7SSean Hefty else 363958afdcb7SSean Hefty ps = cma_select_ib_ps(id_priv); 364058afdcb7SSean Hefty if (!ps) 3641e51060f0SSean Hefty return -EPROTONOSUPPORT; 3642e51060f0SSean Hefty 3643e51060f0SSean Hefty mutex_lock(&lock); 3644f4753834SSean Hefty if (cma_any_port(cma_src_addr(id_priv))) 3645aedec080SSean Hefty ret = cma_alloc_any_port(ps, id_priv); 3646e51060f0SSean Hefty else 3647e51060f0SSean Hefty ret = cma_use_port(ps, id_priv); 3648e51060f0SSean Hefty mutex_unlock(&lock); 3649e51060f0SSean Hefty 3650e51060f0SSean Hefty return ret; 3651e51060f0SSean Hefty } 3652e51060f0SSean Hefty 3653d14714dfSSean Hefty static int cma_check_linklocal(struct rdma_dev_addr *dev_addr, 3654d14714dfSSean Hefty struct sockaddr *addr) 3655d14714dfSSean Hefty { 3656d90f9b35SRoland Dreier #if IS_ENABLED(CONFIG_IPV6) 3657d14714dfSSean Hefty struct sockaddr_in6 *sin6; 3658d14714dfSSean Hefty 3659d14714dfSSean Hefty if (addr->sa_family != AF_INET6) 3660d14714dfSSean Hefty return 0; 3661d14714dfSSean Hefty 3662d14714dfSSean Hefty sin6 = (struct sockaddr_in6 *) addr; 36635462edddSSomnath Kotur 36645462edddSSomnath Kotur if (!(ipv6_addr_type(&sin6->sin6_addr) & IPV6_ADDR_LINKLOCAL)) 36655462edddSSomnath Kotur return 0; 36665462edddSSomnath Kotur 36675462edddSSomnath Kotur if (!sin6->sin6_scope_id) 3668d14714dfSSean Hefty return -EINVAL; 3669d14714dfSSean Hefty 3670d14714dfSSean Hefty dev_addr->bound_dev_if = sin6->sin6_scope_id; 3671d14714dfSSean Hefty #endif 3672d14714dfSSean Hefty return 0; 3673d14714dfSSean Hefty } 3674d14714dfSSean Hefty 3675a9bb7912SHefty, Sean int rdma_listen(struct rdma_cm_id *id, int backlog) 3676a9bb7912SHefty, Sean { 3677732d41c5SJason Gunthorpe struct rdma_id_private *id_priv = 3678732d41c5SJason Gunthorpe container_of(id, struct rdma_id_private, id); 3679a9bb7912SHefty, Sean int ret; 3680a9bb7912SHefty, Sean 3681732d41c5SJason Gunthorpe if (!cma_comp_exch(id_priv, RDMA_CM_ADDR_BOUND, RDMA_CM_LISTEN)) { 3682732d41c5SJason Gunthorpe /* For a well behaved ULP state will be RDMA_CM_IDLE */ 3683f4753834SSean Hefty id->route.addr.src_addr.ss_family = AF_INET; 3684f4753834SSean Hefty ret = rdma_bind_addr(id, cma_src_addr(id_priv)); 3685a9bb7912SHefty, Sean if (ret) 3686a9bb7912SHefty, Sean return ret; 3687732d41c5SJason Gunthorpe if (WARN_ON(!cma_comp_exch(id_priv, RDMA_CM_ADDR_BOUND, 3688732d41c5SJason Gunthorpe RDMA_CM_LISTEN))) 3689a9bb7912SHefty, Sean return -EINVAL; 3690a9bb7912SHefty, Sean } 3691a9bb7912SHefty, Sean 3692d490ee52SJason Gunthorpe /* 3693d490ee52SJason Gunthorpe * Once the ID reaches RDMA_CM_LISTEN it is not allowed to be reusable 3694d490ee52SJason Gunthorpe * any more, and has to be unique in the bind list. 3695d490ee52SJason Gunthorpe */ 3696a9bb7912SHefty, Sean if (id_priv->reuseaddr) { 3697d490ee52SJason Gunthorpe mutex_lock(&lock); 3698d490ee52SJason Gunthorpe ret = cma_check_port(id_priv->bind_list, id_priv, 0); 3699d490ee52SJason Gunthorpe if (!ret) 3700d490ee52SJason Gunthorpe id_priv->reuseaddr = 0; 3701d490ee52SJason Gunthorpe mutex_unlock(&lock); 3702a9bb7912SHefty, Sean if (ret) 3703a9bb7912SHefty, Sean goto err; 3704a9bb7912SHefty, Sean } 3705a9bb7912SHefty, Sean 3706a9bb7912SHefty, Sean id_priv->backlog = backlog; 3707a9bb7912SHefty, Sean if (id->device) { 370872219ceaSMichael Wang if (rdma_cap_ib_cm(id->device, 1)) { 3709a9bb7912SHefty, Sean ret = cma_ib_listen(id_priv); 3710a9bb7912SHefty, Sean if (ret) 3711a9bb7912SHefty, Sean goto err; 371204215330SMichael Wang } else if (rdma_cap_iw_cm(id->device, 1)) { 3713a9bb7912SHefty, Sean ret = cma_iw_listen(id_priv, backlog); 3714a9bb7912SHefty, Sean if (ret) 3715a9bb7912SHefty, Sean goto err; 371621655afcSMichael Wang } else { 3717a9bb7912SHefty, Sean ret = -ENOSYS; 3718a9bb7912SHefty, Sean goto err; 3719a9bb7912SHefty, Sean } 3720c80a0c52SLeon Romanovsky } else { 3721c80a0c52SLeon Romanovsky ret = cma_listen_on_all(id_priv); 3722c80a0c52SLeon Romanovsky if (ret) 3723c80a0c52SLeon Romanovsky goto err; 3724c80a0c52SLeon Romanovsky } 3725a9bb7912SHefty, Sean 3726a9bb7912SHefty, Sean return 0; 3727a9bb7912SHefty, Sean err: 3728a9bb7912SHefty, Sean id_priv->backlog = 0; 3729d490ee52SJason Gunthorpe /* 3730d490ee52SJason Gunthorpe * All the failure paths that lead here will not allow the req_handler's 3731d490ee52SJason Gunthorpe * to have run. 3732d490ee52SJason Gunthorpe */ 3733550e5ca7SNir Muchtar cma_comp_exch(id_priv, RDMA_CM_LISTEN, RDMA_CM_ADDR_BOUND); 3734a9bb7912SHefty, Sean return ret; 3735a9bb7912SHefty, Sean } 3736a9bb7912SHefty, Sean EXPORT_SYMBOL(rdma_listen); 3737a9bb7912SHefty, Sean 3738e51060f0SSean Hefty int rdma_bind_addr(struct rdma_cm_id *id, struct sockaddr *addr) 3739e51060f0SSean Hefty { 3740e51060f0SSean Hefty struct rdma_id_private *id_priv; 3741e51060f0SSean Hefty int ret; 37426df6b4a9SMoni Shoua struct sockaddr *daddr; 3743e51060f0SSean Hefty 3744680f920aSSean Hefty if (addr->sa_family != AF_INET && addr->sa_family != AF_INET6 && 3745680f920aSSean Hefty addr->sa_family != AF_IB) 3746e51060f0SSean Hefty return -EAFNOSUPPORT; 3747e51060f0SSean Hefty 3748e51060f0SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 3749550e5ca7SNir Muchtar if (!cma_comp_exch(id_priv, RDMA_CM_IDLE, RDMA_CM_ADDR_BOUND)) 3750e51060f0SSean Hefty return -EINVAL; 3751e51060f0SSean Hefty 3752d14714dfSSean Hefty ret = cma_check_linklocal(&id->route.addr.dev_addr, addr); 3753d14714dfSSean Hefty if (ret) 3754d14714dfSSean Hefty goto err1; 3755d14714dfSSean Hefty 37567b85627bSMoni Shoua memcpy(cma_src_addr(id_priv), addr, rdma_addr_size(addr)); 37578523c048SSean Hefty if (!cma_any_addr(addr)) { 3758680f920aSSean Hefty ret = cma_translate_addr(addr, &id->route.addr.dev_addr); 3759255d0c14SKrishna Kumar if (ret) 3760255d0c14SKrishna Kumar goto err1; 3761255d0c14SKrishna Kumar 3762ff11c6cdSParav Pandit ret = cma_acquire_dev_by_src_ip(id_priv); 3763e51060f0SSean Hefty if (ret) 3764255d0c14SKrishna Kumar goto err1; 3765e51060f0SSean Hefty } 3766e51060f0SSean Hefty 376768602120SSean Hefty if (!(id_priv->options & (1 << CMA_OPTION_AFONLY))) { 37685b0ec991SSean Hefty if (addr->sa_family == AF_INET) 37695b0ec991SSean Hefty id_priv->afonly = 1; 37705b0ec991SSean Hefty #if IS_ENABLED(CONFIG_IPV6) 3771fa20105eSGuy Shapiro else if (addr->sa_family == AF_INET6) { 3772fa20105eSGuy Shapiro struct net *net = id_priv->id.route.addr.dev_addr.net; 3773fa20105eSGuy Shapiro 3774fa20105eSGuy Shapiro id_priv->afonly = net->ipv6.sysctl.bindv6only; 3775fa20105eSGuy Shapiro } 37765b0ec991SSean Hefty #endif 377768602120SSean Hefty } 37789dea9a2fSTatyana Nikolova daddr = cma_dst_addr(id_priv); 37799dea9a2fSTatyana Nikolova daddr->sa_family = addr->sa_family; 37809dea9a2fSTatyana Nikolova 3781e51060f0SSean Hefty ret = cma_get_port(id_priv); 3782e51060f0SSean Hefty if (ret) 3783255d0c14SKrishna Kumar goto err2; 3784e51060f0SSean Hefty 3785e51060f0SSean Hefty return 0; 3786255d0c14SKrishna Kumar err2: 3787ed7a01fdSLeon Romanovsky if (id_priv->cma_dev) 3788a396d43aSSean Hefty cma_release_dev(id_priv); 3789255d0c14SKrishna Kumar err1: 3790550e5ca7SNir Muchtar cma_comp_exch(id_priv, RDMA_CM_ADDR_BOUND, RDMA_CM_IDLE); 3791e51060f0SSean Hefty return ret; 3792e51060f0SSean Hefty } 3793e51060f0SSean Hefty EXPORT_SYMBOL(rdma_bind_addr); 3794e51060f0SSean Hefty 3795f4753834SSean Hefty static int cma_format_hdr(void *hdr, struct rdma_id_private *id_priv) 3796e51060f0SSean Hefty { 3797e51060f0SSean Hefty struct cma_hdr *cma_hdr; 3798e51060f0SSean Hefty 379901602f11SSean Hefty cma_hdr = hdr; 380001602f11SSean Hefty cma_hdr->cma_version = CMA_VERSION; 3801f4753834SSean Hefty if (cma_family(id_priv) == AF_INET) { 38021f5175adSAleksey Senin struct sockaddr_in *src4, *dst4; 38031f5175adSAleksey Senin 3804f4753834SSean Hefty src4 = (struct sockaddr_in *) cma_src_addr(id_priv); 3805f4753834SSean Hefty dst4 = (struct sockaddr_in *) cma_dst_addr(id_priv); 3806e51060f0SSean Hefty 3807e51060f0SSean Hefty cma_set_ip_ver(cma_hdr, 4); 3808e51060f0SSean Hefty cma_hdr->src_addr.ip4.addr = src4->sin_addr.s_addr; 3809e51060f0SSean Hefty cma_hdr->dst_addr.ip4.addr = dst4->sin_addr.s_addr; 3810e51060f0SSean Hefty cma_hdr->port = src4->sin_port; 3811e8160e15SSean Hefty } else if (cma_family(id_priv) == AF_INET6) { 38121f5175adSAleksey Senin struct sockaddr_in6 *src6, *dst6; 38131f5175adSAleksey Senin 3814f4753834SSean Hefty src6 = (struct sockaddr_in6 *) cma_src_addr(id_priv); 3815f4753834SSean Hefty dst6 = (struct sockaddr_in6 *) cma_dst_addr(id_priv); 38161f5175adSAleksey Senin 38171f5175adSAleksey Senin cma_set_ip_ver(cma_hdr, 6); 38181f5175adSAleksey Senin cma_hdr->src_addr.ip6 = src6->sin6_addr; 38191f5175adSAleksey Senin cma_hdr->dst_addr.ip6 = dst6->sin6_addr; 38201f5175adSAleksey Senin cma_hdr->port = src6->sin6_port; 38211f5175adSAleksey Senin } 3822e51060f0SSean Hefty return 0; 3823e51060f0SSean Hefty } 3824e51060f0SSean Hefty 3825628e5f6dSSean Hefty static int cma_sidr_rep_handler(struct ib_cm_id *cm_id, 3826e7ff98aeSParav Pandit const struct ib_cm_event *ib_event) 3827628e5f6dSSean Hefty { 3828628e5f6dSSean Hefty struct rdma_id_private *id_priv = cm_id->context; 38297582df82SParav Pandit struct rdma_cm_event event = {}; 3830e7ff98aeSParav Pandit const struct ib_cm_sidr_rep_event_param *rep = 3831e7ff98aeSParav Pandit &ib_event->param.sidr_rep_rcvd; 3832f6a9d47aSJason Gunthorpe int ret; 3833628e5f6dSSean Hefty 383437e07cdaSBart Van Assche mutex_lock(&id_priv->handler_mutex); 38352a7cec53SJason Gunthorpe if (READ_ONCE(id_priv->state) != RDMA_CM_CONNECT) 383637e07cdaSBart Van Assche goto out; 3837628e5f6dSSean Hefty 3838628e5f6dSSean Hefty switch (ib_event->event) { 3839628e5f6dSSean Hefty case IB_CM_SIDR_REQ_ERROR: 3840628e5f6dSSean Hefty event.event = RDMA_CM_EVENT_UNREACHABLE; 3841628e5f6dSSean Hefty event.status = -ETIMEDOUT; 3842628e5f6dSSean Hefty break; 3843628e5f6dSSean Hefty case IB_CM_SIDR_REP_RECEIVED: 3844628e5f6dSSean Hefty event.param.ud.private_data = ib_event->private_data; 3845628e5f6dSSean Hefty event.param.ud.private_data_len = IB_CM_SIDR_REP_PRIVATE_DATA_SIZE; 3846628e5f6dSSean Hefty if (rep->status != IB_SIDR_SUCCESS) { 3847628e5f6dSSean Hefty event.event = RDMA_CM_EVENT_UNREACHABLE; 3848628e5f6dSSean Hefty event.status = ib_event->param.sidr_rep_rcvd.status; 3849498683c6SMoni Shoua pr_debug_ratelimited("RDMA CM: UNREACHABLE: bad SIDR reply. status %d\n", 3850498683c6SMoni Shoua event.status); 3851628e5f6dSSean Hefty break; 3852628e5f6dSSean Hefty } 38535c438135SSean Hefty ret = cma_set_qkey(id_priv, rep->qkey); 3854d2ca39f2SYossi Etigin if (ret) { 3855498683c6SMoni Shoua pr_debug_ratelimited("RDMA CM: ADDR_ERROR: failed to set qkey. status %d\n", ret); 3856d2ca39f2SYossi Etigin event.event = RDMA_CM_EVENT_ADDR_ERROR; 38575c438135SSean Hefty event.status = ret; 3858628e5f6dSSean Hefty break; 3859628e5f6dSSean Hefty } 38604ad6a024SParav Pandit ib_init_ah_attr_from_path(id_priv->id.device, 38614ad6a024SParav Pandit id_priv->id.port_num, 3862628e5f6dSSean Hefty id_priv->id.route.path_rec, 386339839107SParav Pandit &event.param.ud.ah_attr, 386439839107SParav Pandit rep->sgid_attr); 3865628e5f6dSSean Hefty event.param.ud.qp_num = rep->qpn; 3866628e5f6dSSean Hefty event.param.ud.qkey = rep->qkey; 3867628e5f6dSSean Hefty event.event = RDMA_CM_EVENT_ESTABLISHED; 3868628e5f6dSSean Hefty event.status = 0; 3869628e5f6dSSean Hefty break; 3870628e5f6dSSean Hefty default: 3871aba25a3eSParav Pandit pr_err("RDMA CMA: unexpected IB CM event: %d\n", 3872628e5f6dSSean Hefty ib_event->event); 3873628e5f6dSSean Hefty goto out; 3874628e5f6dSSean Hefty } 3875628e5f6dSSean Hefty 3876ed999f82SChuck Lever ret = cma_cm_event_handler(id_priv, &event); 3877aa74f487SParav Pandit 3878aa74f487SParav Pandit rdma_destroy_ah_attr(&event.param.ud.ah_attr); 3879628e5f6dSSean Hefty if (ret) { 3880628e5f6dSSean Hefty /* Destroy the CM ID by returning a non-zero value. */ 3881628e5f6dSSean Hefty id_priv->cm_id.ib = NULL; 3882f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(id_priv); 3883628e5f6dSSean Hefty return ret; 3884628e5f6dSSean Hefty } 3885628e5f6dSSean Hefty out: 3886de910bd9SOr Gerlitz mutex_unlock(&id_priv->handler_mutex); 3887f6a9d47aSJason Gunthorpe return 0; 3888628e5f6dSSean Hefty } 3889628e5f6dSSean Hefty 3890628e5f6dSSean Hefty static int cma_resolve_ib_udp(struct rdma_id_private *id_priv, 3891628e5f6dSSean Hefty struct rdma_conn_param *conn_param) 3892628e5f6dSSean Hefty { 3893628e5f6dSSean Hefty struct ib_cm_sidr_req_param req; 38940c9361fcSJack Morgenstein struct ib_cm_id *id; 3895e511d1aeSSean Hefty void *private_data; 3896c0b64f58SBart Van Assche u8 offset; 3897c0b64f58SBart Van Assche int ret; 3898628e5f6dSSean Hefty 3899e511d1aeSSean Hefty memset(&req, 0, sizeof req); 3900e8160e15SSean Hefty offset = cma_user_data_offset(id_priv); 3901e8160e15SSean Hefty req.private_data_len = offset + conn_param->private_data_len; 390204ded167SSean Hefty if (req.private_data_len < conn_param->private_data_len) 390304ded167SSean Hefty return -EINVAL; 390404ded167SSean Hefty 3905e8160e15SSean Hefty if (req.private_data_len) { 3906e511d1aeSSean Hefty private_data = kzalloc(req.private_data_len, GFP_ATOMIC); 3907e511d1aeSSean Hefty if (!private_data) 3908628e5f6dSSean Hefty return -ENOMEM; 3909e8160e15SSean Hefty } else { 3910e511d1aeSSean Hefty private_data = NULL; 3911e8160e15SSean Hefty } 3912628e5f6dSSean Hefty 3913628e5f6dSSean Hefty if (conn_param->private_data && conn_param->private_data_len) 3914e511d1aeSSean Hefty memcpy(private_data + offset, conn_param->private_data, 3915e511d1aeSSean Hefty conn_param->private_data_len); 3916628e5f6dSSean Hefty 3917e511d1aeSSean Hefty if (private_data) { 3918e511d1aeSSean Hefty ret = cma_format_hdr(private_data, id_priv); 3919628e5f6dSSean Hefty if (ret) 3920628e5f6dSSean Hefty goto out; 3921e511d1aeSSean Hefty req.private_data = private_data; 3922e8160e15SSean Hefty } 3923628e5f6dSSean Hefty 39240c9361fcSJack Morgenstein id = ib_create_cm_id(id_priv->id.device, cma_sidr_rep_handler, 39250c9361fcSJack Morgenstein id_priv); 39260c9361fcSJack Morgenstein if (IS_ERR(id)) { 39270c9361fcSJack Morgenstein ret = PTR_ERR(id); 3928628e5f6dSSean Hefty goto out; 3929628e5f6dSSean Hefty } 39300c9361fcSJack Morgenstein id_priv->cm_id.ib = id; 3931628e5f6dSSean Hefty 3932f4753834SSean Hefty req.path = id_priv->id.route.path_rec; 3933815d456eSParav Pandit req.sgid_attr = id_priv->id.route.addr.dev_addr.sgid_attr; 3934cf53936fSSean Hefty req.service_id = rdma_get_service_id(&id_priv->id, cma_dst_addr(id_priv)); 3935628e5f6dSSean Hefty req.timeout_ms = 1 << (CMA_CM_RESPONSE_TIMEOUT - 8); 3936628e5f6dSSean Hefty req.max_cm_retries = CMA_MAX_CM_RETRIES; 3937628e5f6dSSean Hefty 3938ed999f82SChuck Lever trace_cm_send_sidr_req(id_priv); 3939628e5f6dSSean Hefty ret = ib_send_cm_sidr_req(id_priv->cm_id.ib, &req); 3940628e5f6dSSean Hefty if (ret) { 3941628e5f6dSSean Hefty ib_destroy_cm_id(id_priv->cm_id.ib); 3942628e5f6dSSean Hefty id_priv->cm_id.ib = NULL; 3943628e5f6dSSean Hefty } 3944628e5f6dSSean Hefty out: 3945e511d1aeSSean Hefty kfree(private_data); 3946628e5f6dSSean Hefty return ret; 3947628e5f6dSSean Hefty } 3948628e5f6dSSean Hefty 3949e51060f0SSean Hefty static int cma_connect_ib(struct rdma_id_private *id_priv, 3950e51060f0SSean Hefty struct rdma_conn_param *conn_param) 3951e51060f0SSean Hefty { 3952e51060f0SSean Hefty struct ib_cm_req_param req; 3953e51060f0SSean Hefty struct rdma_route *route; 3954e51060f0SSean Hefty void *private_data; 39550c9361fcSJack Morgenstein struct ib_cm_id *id; 3956c0b64f58SBart Van Assche u8 offset; 3957c0b64f58SBart Van Assche int ret; 3958e51060f0SSean Hefty 3959e51060f0SSean Hefty memset(&req, 0, sizeof req); 3960e8160e15SSean Hefty offset = cma_user_data_offset(id_priv); 3961e51060f0SSean Hefty req.private_data_len = offset + conn_param->private_data_len; 396204ded167SSean Hefty if (req.private_data_len < conn_param->private_data_len) 396304ded167SSean Hefty return -EINVAL; 396404ded167SSean Hefty 3965e8160e15SSean Hefty if (req.private_data_len) { 3966e51060f0SSean Hefty private_data = kzalloc(req.private_data_len, GFP_ATOMIC); 3967e51060f0SSean Hefty if (!private_data) 3968e51060f0SSean Hefty return -ENOMEM; 3969e8160e15SSean Hefty } else { 3970e8160e15SSean Hefty private_data = NULL; 3971e8160e15SSean Hefty } 3972e51060f0SSean Hefty 3973e51060f0SSean Hefty if (conn_param->private_data && conn_param->private_data_len) 3974e51060f0SSean Hefty memcpy(private_data + offset, conn_param->private_data, 3975e51060f0SSean Hefty conn_param->private_data_len); 3976e51060f0SSean Hefty 39770c9361fcSJack Morgenstein id = ib_create_cm_id(id_priv->id.device, cma_ib_handler, id_priv); 39780c9361fcSJack Morgenstein if (IS_ERR(id)) { 39790c9361fcSJack Morgenstein ret = PTR_ERR(id); 3980e51060f0SSean Hefty goto out; 3981e51060f0SSean Hefty } 39820c9361fcSJack Morgenstein id_priv->cm_id.ib = id; 3983e51060f0SSean Hefty 3984e51060f0SSean Hefty route = &id_priv->id.route; 3985e8160e15SSean Hefty if (private_data) { 3986f4753834SSean Hefty ret = cma_format_hdr(private_data, id_priv); 3987e51060f0SSean Hefty if (ret) 3988e51060f0SSean Hefty goto out; 3989e51060f0SSean Hefty req.private_data = private_data; 3990e8160e15SSean Hefty } 3991e51060f0SSean Hefty 3992e51060f0SSean Hefty req.primary_path = &route->path_rec[0]; 3993e51060f0SSean Hefty if (route->num_paths == 2) 3994e51060f0SSean Hefty req.alternate_path = &route->path_rec[1]; 3995e51060f0SSean Hefty 3996815d456eSParav Pandit req.ppath_sgid_attr = id_priv->id.route.addr.dev_addr.sgid_attr; 3997815d456eSParav Pandit /* Alternate path SGID attribute currently unsupported */ 3998cf53936fSSean Hefty req.service_id = rdma_get_service_id(&id_priv->id, cma_dst_addr(id_priv)); 3999e51060f0SSean Hefty req.qp_num = id_priv->qp_num; 400018c441a6SSean Hefty req.qp_type = id_priv->id.qp_type; 4001e51060f0SSean Hefty req.starting_psn = id_priv->seq_num; 4002e51060f0SSean Hefty req.responder_resources = conn_param->responder_resources; 4003e51060f0SSean Hefty req.initiator_depth = conn_param->initiator_depth; 4004e51060f0SSean Hefty req.flow_control = conn_param->flow_control; 40054ede178aSSean Hefty req.retry_count = min_t(u8, 7, conn_param->retry_count); 40064ede178aSSean Hefty req.rnr_retry_count = min_t(u8, 7, conn_param->rnr_retry_count); 4007e51060f0SSean Hefty req.remote_cm_response_timeout = CMA_CM_RESPONSE_TIMEOUT; 4008e51060f0SSean Hefty req.local_cm_response_timeout = CMA_CM_RESPONSE_TIMEOUT; 4009e51060f0SSean Hefty req.max_cm_retries = CMA_MAX_CM_RETRIES; 4010e51060f0SSean Hefty req.srq = id_priv->srq ? 1 : 0; 4011a20652e1SLeon Romanovsky req.ece.vendor_id = id_priv->ece.vendor_id; 4012a20652e1SLeon Romanovsky req.ece.attr_mod = id_priv->ece.attr_mod; 4013e51060f0SSean Hefty 4014ed999f82SChuck Lever trace_cm_send_req(id_priv); 4015e51060f0SSean Hefty ret = ib_send_cm_req(id_priv->cm_id.ib, &req); 4016e51060f0SSean Hefty out: 40170c9361fcSJack Morgenstein if (ret && !IS_ERR(id)) { 40180c9361fcSJack Morgenstein ib_destroy_cm_id(id); 4019675a027cSKrishna Kumar id_priv->cm_id.ib = NULL; 4020675a027cSKrishna Kumar } 4021675a027cSKrishna Kumar 4022e51060f0SSean Hefty kfree(private_data); 4023e51060f0SSean Hefty return ret; 4024e51060f0SSean Hefty } 4025e51060f0SSean Hefty 402607ebafbaSTom Tucker static int cma_connect_iw(struct rdma_id_private *id_priv, 402707ebafbaSTom Tucker struct rdma_conn_param *conn_param) 402807ebafbaSTom Tucker { 402907ebafbaSTom Tucker struct iw_cm_id *cm_id; 403007ebafbaSTom Tucker int ret; 403107ebafbaSTom Tucker struct iw_cm_conn_param iw_param; 403207ebafbaSTom Tucker 403307ebafbaSTom Tucker cm_id = iw_create_cm_id(id_priv->id.device, cma_iw_handler, id_priv); 40340c9361fcSJack Morgenstein if (IS_ERR(cm_id)) 40350c9361fcSJack Morgenstein return PTR_ERR(cm_id); 403607ebafbaSTom Tucker 403768cdba06SSteve Wise cm_id->tos = id_priv->tos; 4038926ba19bSSteve Wise cm_id->tos_set = id_priv->tos_set; 403907ebafbaSTom Tucker id_priv->cm_id.iw = cm_id; 404007ebafbaSTom Tucker 404124d44a39SSteve Wise memcpy(&cm_id->local_addr, cma_src_addr(id_priv), 404224d44a39SSteve Wise rdma_addr_size(cma_src_addr(id_priv))); 404324d44a39SSteve Wise memcpy(&cm_id->remote_addr, cma_dst_addr(id_priv), 404424d44a39SSteve Wise rdma_addr_size(cma_dst_addr(id_priv))); 404507ebafbaSTom Tucker 40465851bb89SSean Hefty ret = cma_modify_qp_rtr(id_priv, conn_param); 4047675a027cSKrishna Kumar if (ret) 4048675a027cSKrishna Kumar goto out; 404907ebafbaSTom Tucker 4050f45ee80eSHefty, Sean if (conn_param) { 405107ebafbaSTom Tucker iw_param.ord = conn_param->initiator_depth; 405207ebafbaSTom Tucker iw_param.ird = conn_param->responder_resources; 405307ebafbaSTom Tucker iw_param.private_data = conn_param->private_data; 405407ebafbaSTom Tucker iw_param.private_data_len = conn_param->private_data_len; 4055f45ee80eSHefty, Sean iw_param.qpn = id_priv->id.qp ? id_priv->qp_num : conn_param->qp_num; 4056f45ee80eSHefty, Sean } else { 4057f45ee80eSHefty, Sean memset(&iw_param, 0, sizeof iw_param); 405807ebafbaSTom Tucker iw_param.qpn = id_priv->qp_num; 4059f45ee80eSHefty, Sean } 406007ebafbaSTom Tucker ret = iw_cm_connect(cm_id, &iw_param); 406107ebafbaSTom Tucker out: 40620c9361fcSJack Morgenstein if (ret) { 4063675a027cSKrishna Kumar iw_destroy_cm_id(cm_id); 4064675a027cSKrishna Kumar id_priv->cm_id.iw = NULL; 4065675a027cSKrishna Kumar } 406607ebafbaSTom Tucker return ret; 406707ebafbaSTom Tucker } 406807ebafbaSTom Tucker 4069071ba4ccSJason Gunthorpe /** 4070071ba4ccSJason Gunthorpe * rdma_connect_locked - Initiate an active connection request. 4071071ba4ccSJason Gunthorpe * @id: Connection identifier to connect. 4072071ba4ccSJason Gunthorpe * @conn_param: Connection information used for connected QPs. 4073071ba4ccSJason Gunthorpe * 4074071ba4ccSJason Gunthorpe * Same as rdma_connect() but can only be called from the 4075071ba4ccSJason Gunthorpe * RDMA_CM_EVENT_ROUTE_RESOLVED handler callback. 4076071ba4ccSJason Gunthorpe */ 4077071ba4ccSJason Gunthorpe int rdma_connect_locked(struct rdma_cm_id *id, 4078071ba4ccSJason Gunthorpe struct rdma_conn_param *conn_param) 4079e51060f0SSean Hefty { 40802a7cec53SJason Gunthorpe struct rdma_id_private *id_priv = 40812a7cec53SJason Gunthorpe container_of(id, struct rdma_id_private, id); 4082e51060f0SSean Hefty int ret; 4083e51060f0SSean Hefty 4084071ba4ccSJason Gunthorpe if (!cma_comp_exch(id_priv, RDMA_CM_ROUTE_RESOLVED, RDMA_CM_CONNECT)) 4085071ba4ccSJason Gunthorpe return -EINVAL; 4086e51060f0SSean Hefty 4087e51060f0SSean Hefty if (!id->qp) { 4088e51060f0SSean Hefty id_priv->qp_num = conn_param->qp_num; 4089e51060f0SSean Hefty id_priv->srq = conn_param->srq; 4090e51060f0SSean Hefty } 4091e51060f0SSean Hefty 409272219ceaSMichael Wang if (rdma_cap_ib_cm(id->device, id->port_num)) { 4093b26f9b99SSean Hefty if (id->qp_type == IB_QPT_UD) 4094628e5f6dSSean Hefty ret = cma_resolve_ib_udp(id_priv, conn_param); 4095628e5f6dSSean Hefty else 4096e51060f0SSean Hefty ret = cma_connect_ib(id_priv, conn_param); 409704215330SMichael Wang } else if (rdma_cap_iw_cm(id->device, id->port_num)) 409807ebafbaSTom Tucker ret = cma_connect_iw(id_priv, conn_param); 409921655afcSMichael Wang else 4100e51060f0SSean Hefty ret = -ENOSYS; 4101e51060f0SSean Hefty if (ret) 41022a7cec53SJason Gunthorpe goto err_state; 4103e51060f0SSean Hefty return 0; 41042a7cec53SJason Gunthorpe err_state: 4105550e5ca7SNir Muchtar cma_comp_exch(id_priv, RDMA_CM_CONNECT, RDMA_CM_ROUTE_RESOLVED); 4106071ba4ccSJason Gunthorpe return ret; 4107071ba4ccSJason Gunthorpe } 4108071ba4ccSJason Gunthorpe EXPORT_SYMBOL(rdma_connect_locked); 4109071ba4ccSJason Gunthorpe 4110071ba4ccSJason Gunthorpe /** 4111071ba4ccSJason Gunthorpe * rdma_connect - Initiate an active connection request. 4112071ba4ccSJason Gunthorpe * @id: Connection identifier to connect. 4113071ba4ccSJason Gunthorpe * @conn_param: Connection information used for connected QPs. 4114071ba4ccSJason Gunthorpe * 4115071ba4ccSJason Gunthorpe * Users must have resolved a route for the rdma_cm_id to connect with by having 4116071ba4ccSJason Gunthorpe * called rdma_resolve_route before calling this routine. 4117071ba4ccSJason Gunthorpe * 4118071ba4ccSJason Gunthorpe * This call will either connect to a remote QP or obtain remote QP information 4119071ba4ccSJason Gunthorpe * for unconnected rdma_cm_id's. The actual operation is based on the 4120071ba4ccSJason Gunthorpe * rdma_cm_id's port space. 4121071ba4ccSJason Gunthorpe */ 4122071ba4ccSJason Gunthorpe int rdma_connect(struct rdma_cm_id *id, struct rdma_conn_param *conn_param) 4123071ba4ccSJason Gunthorpe { 4124071ba4ccSJason Gunthorpe struct rdma_id_private *id_priv = 4125071ba4ccSJason Gunthorpe container_of(id, struct rdma_id_private, id); 4126071ba4ccSJason Gunthorpe int ret; 4127071ba4ccSJason Gunthorpe 4128071ba4ccSJason Gunthorpe mutex_lock(&id_priv->handler_mutex); 4129071ba4ccSJason Gunthorpe ret = rdma_connect_locked(id, conn_param); 41302a7cec53SJason Gunthorpe mutex_unlock(&id_priv->handler_mutex); 4131e51060f0SSean Hefty return ret; 4132e51060f0SSean Hefty } 4133e51060f0SSean Hefty EXPORT_SYMBOL(rdma_connect); 4134e51060f0SSean Hefty 413534e2ab57SLeon Romanovsky /** 413634e2ab57SLeon Romanovsky * rdma_connect_ece - Initiate an active connection request with ECE data. 413734e2ab57SLeon Romanovsky * @id: Connection identifier to connect. 413834e2ab57SLeon Romanovsky * @conn_param: Connection information used for connected QPs. 413934e2ab57SLeon Romanovsky * @ece: ECE parameters 414034e2ab57SLeon Romanovsky * 414134e2ab57SLeon Romanovsky * See rdma_connect() explanation. 414234e2ab57SLeon Romanovsky */ 414334e2ab57SLeon Romanovsky int rdma_connect_ece(struct rdma_cm_id *id, struct rdma_conn_param *conn_param, 414434e2ab57SLeon Romanovsky struct rdma_ucm_ece *ece) 414534e2ab57SLeon Romanovsky { 414634e2ab57SLeon Romanovsky struct rdma_id_private *id_priv = 414734e2ab57SLeon Romanovsky container_of(id, struct rdma_id_private, id); 414834e2ab57SLeon Romanovsky 414934e2ab57SLeon Romanovsky id_priv->ece.vendor_id = ece->vendor_id; 415034e2ab57SLeon Romanovsky id_priv->ece.attr_mod = ece->attr_mod; 415134e2ab57SLeon Romanovsky 415234e2ab57SLeon Romanovsky return rdma_connect(id, conn_param); 415334e2ab57SLeon Romanovsky } 415434e2ab57SLeon Romanovsky EXPORT_SYMBOL(rdma_connect_ece); 415534e2ab57SLeon Romanovsky 4156e51060f0SSean Hefty static int cma_accept_ib(struct rdma_id_private *id_priv, 4157e51060f0SSean Hefty struct rdma_conn_param *conn_param) 4158e51060f0SSean Hefty { 4159e51060f0SSean Hefty struct ib_cm_rep_param rep; 41605851bb89SSean Hefty int ret; 4161e51060f0SSean Hefty 41625851bb89SSean Hefty ret = cma_modify_qp_rtr(id_priv, conn_param); 4163e51060f0SSean Hefty if (ret) 41640fe313b0SSean Hefty goto out; 41650fe313b0SSean Hefty 41665851bb89SSean Hefty ret = cma_modify_qp_rts(id_priv, conn_param); 41670fe313b0SSean Hefty if (ret) 41680fe313b0SSean Hefty goto out; 41690fe313b0SSean Hefty 4170e51060f0SSean Hefty memset(&rep, 0, sizeof rep); 4171e51060f0SSean Hefty rep.qp_num = id_priv->qp_num; 4172e51060f0SSean Hefty rep.starting_psn = id_priv->seq_num; 4173e51060f0SSean Hefty rep.private_data = conn_param->private_data; 4174e51060f0SSean Hefty rep.private_data_len = conn_param->private_data_len; 4175e51060f0SSean Hefty rep.responder_resources = conn_param->responder_resources; 4176e51060f0SSean Hefty rep.initiator_depth = conn_param->initiator_depth; 4177e51060f0SSean Hefty rep.failover_accepted = 0; 4178e51060f0SSean Hefty rep.flow_control = conn_param->flow_control; 41794ede178aSSean Hefty rep.rnr_retry_count = min_t(u8, 7, conn_param->rnr_retry_count); 4180e51060f0SSean Hefty rep.srq = id_priv->srq ? 1 : 0; 41810cb15372SLeon Romanovsky rep.ece.vendor_id = id_priv->ece.vendor_id; 41820cb15372SLeon Romanovsky rep.ece.attr_mod = id_priv->ece.attr_mod; 4183e51060f0SSean Hefty 4184ed999f82SChuck Lever trace_cm_send_rep(id_priv); 41850fe313b0SSean Hefty ret = ib_send_cm_rep(id_priv->cm_id.ib, &rep); 41860fe313b0SSean Hefty out: 41870fe313b0SSean Hefty return ret; 4188e51060f0SSean Hefty } 4189e51060f0SSean Hefty 419007ebafbaSTom Tucker static int cma_accept_iw(struct rdma_id_private *id_priv, 419107ebafbaSTom Tucker struct rdma_conn_param *conn_param) 419207ebafbaSTom Tucker { 419307ebafbaSTom Tucker struct iw_cm_conn_param iw_param; 419407ebafbaSTom Tucker int ret; 419507ebafbaSTom Tucker 4196f2625f7dSSteve Wise if (!conn_param) 4197f2625f7dSSteve Wise return -EINVAL; 4198f2625f7dSSteve Wise 41995851bb89SSean Hefty ret = cma_modify_qp_rtr(id_priv, conn_param); 420007ebafbaSTom Tucker if (ret) 420107ebafbaSTom Tucker return ret; 420207ebafbaSTom Tucker 420307ebafbaSTom Tucker iw_param.ord = conn_param->initiator_depth; 420407ebafbaSTom Tucker iw_param.ird = conn_param->responder_resources; 420507ebafbaSTom Tucker iw_param.private_data = conn_param->private_data; 420607ebafbaSTom Tucker iw_param.private_data_len = conn_param->private_data_len; 420707ebafbaSTom Tucker if (id_priv->id.qp) { 420807ebafbaSTom Tucker iw_param.qpn = id_priv->qp_num; 420907ebafbaSTom Tucker } else 421007ebafbaSTom Tucker iw_param.qpn = conn_param->qp_num; 421107ebafbaSTom Tucker 421207ebafbaSTom Tucker return iw_cm_accept(id_priv->cm_id.iw, &iw_param); 421307ebafbaSTom Tucker } 421407ebafbaSTom Tucker 4215628e5f6dSSean Hefty static int cma_send_sidr_rep(struct rdma_id_private *id_priv, 42165c438135SSean Hefty enum ib_cm_sidr_status status, u32 qkey, 4217628e5f6dSSean Hefty const void *private_data, int private_data_len) 4218628e5f6dSSean Hefty { 4219628e5f6dSSean Hefty struct ib_cm_sidr_rep_param rep; 4220d2ca39f2SYossi Etigin int ret; 4221628e5f6dSSean Hefty 4222628e5f6dSSean Hefty memset(&rep, 0, sizeof rep); 4223628e5f6dSSean Hefty rep.status = status; 4224628e5f6dSSean Hefty if (status == IB_SIDR_SUCCESS) { 42255c438135SSean Hefty ret = cma_set_qkey(id_priv, qkey); 4226d2ca39f2SYossi Etigin if (ret) 4227d2ca39f2SYossi Etigin return ret; 4228628e5f6dSSean Hefty rep.qp_num = id_priv->qp_num; 4229c8f6a362SSean Hefty rep.qkey = id_priv->qkey; 42300cb15372SLeon Romanovsky 42310cb15372SLeon Romanovsky rep.ece.vendor_id = id_priv->ece.vendor_id; 42320cb15372SLeon Romanovsky rep.ece.attr_mod = id_priv->ece.attr_mod; 4233628e5f6dSSean Hefty } 42340cb15372SLeon Romanovsky 4235628e5f6dSSean Hefty rep.private_data = private_data; 4236628e5f6dSSean Hefty rep.private_data_len = private_data_len; 4237628e5f6dSSean Hefty 4238ed999f82SChuck Lever trace_cm_send_sidr_rep(id_priv); 4239628e5f6dSSean Hefty return ib_send_cm_sidr_rep(id_priv->cm_id.ib, &rep); 4240628e5f6dSSean Hefty } 4241628e5f6dSSean Hefty 4242b09c4d70SLeon Romanovsky /** 4243b09c4d70SLeon Romanovsky * rdma_accept - Called to accept a connection request or response. 4244b09c4d70SLeon Romanovsky * @id: Connection identifier associated with the request. 4245b09c4d70SLeon Romanovsky * @conn_param: Information needed to establish the connection. This must be 4246b09c4d70SLeon Romanovsky * provided if accepting a connection request. If accepting a connection 4247b09c4d70SLeon Romanovsky * response, this parameter must be NULL. 4248b09c4d70SLeon Romanovsky * 4249b09c4d70SLeon Romanovsky * Typically, this routine is only called by the listener to accept a connection 4250b09c4d70SLeon Romanovsky * request. It must also be called on the active side of a connection if the 4251b09c4d70SLeon Romanovsky * user is performing their own QP transitions. 4252b09c4d70SLeon Romanovsky * 4253b09c4d70SLeon Romanovsky * In the case of error, a reject message is sent to the remote side and the 4254b09c4d70SLeon Romanovsky * state of the qp associated with the id is modified to error, such that any 4255b09c4d70SLeon Romanovsky * previously posted receive buffers would be flushed. 4256b09c4d70SLeon Romanovsky * 4257b09c4d70SLeon Romanovsky * This function is for use by kernel ULPs and must be called from under the 4258b09c4d70SLeon Romanovsky * handler callback. 4259b09c4d70SLeon Romanovsky */ 4260b09c4d70SLeon Romanovsky int rdma_accept(struct rdma_cm_id *id, struct rdma_conn_param *conn_param) 4261e51060f0SSean Hefty { 4262d114c6feSJason Gunthorpe struct rdma_id_private *id_priv = 4263d114c6feSJason Gunthorpe container_of(id, struct rdma_id_private, id); 4264e51060f0SSean Hefty int ret; 4265e51060f0SSean Hefty 4266d114c6feSJason Gunthorpe lockdep_assert_held(&id_priv->handler_mutex); 426783e9502dSNir Muchtar 4268d114c6feSJason Gunthorpe if (READ_ONCE(id_priv->state) != RDMA_CM_CONNECT) 4269e51060f0SSean Hefty return -EINVAL; 4270e51060f0SSean Hefty 4271e51060f0SSean Hefty if (!id->qp && conn_param) { 4272e51060f0SSean Hefty id_priv->qp_num = conn_param->qp_num; 4273e51060f0SSean Hefty id_priv->srq = conn_param->srq; 4274e51060f0SSean Hefty } 4275e51060f0SSean Hefty 427672219ceaSMichael Wang if (rdma_cap_ib_cm(id->device, id->port_num)) { 4277f45ee80eSHefty, Sean if (id->qp_type == IB_QPT_UD) { 4278f45ee80eSHefty, Sean if (conn_param) 4279628e5f6dSSean Hefty ret = cma_send_sidr_rep(id_priv, IB_SIDR_SUCCESS, 42805c438135SSean Hefty conn_param->qkey, 4281628e5f6dSSean Hefty conn_param->private_data, 4282628e5f6dSSean Hefty conn_param->private_data_len); 4283f45ee80eSHefty, Sean else 4284f45ee80eSHefty, Sean ret = cma_send_sidr_rep(id_priv, IB_SIDR_SUCCESS, 42855c438135SSean Hefty 0, NULL, 0); 4286f45ee80eSHefty, Sean } else { 4287f45ee80eSHefty, Sean if (conn_param) 4288e51060f0SSean Hefty ret = cma_accept_ib(id_priv, conn_param); 4289e51060f0SSean Hefty else 4290e51060f0SSean Hefty ret = cma_rep_recv(id_priv); 4291f45ee80eSHefty, Sean } 429204215330SMichael Wang } else if (rdma_cap_iw_cm(id->device, id->port_num)) 429307ebafbaSTom Tucker ret = cma_accept_iw(id_priv, conn_param); 429421655afcSMichael Wang else 4295e51060f0SSean Hefty ret = -ENOSYS; 4296e51060f0SSean Hefty 4297e51060f0SSean Hefty if (ret) 4298e51060f0SSean Hefty goto reject; 4299e51060f0SSean Hefty 4300e51060f0SSean Hefty return 0; 4301e51060f0SSean Hefty reject: 4302c5483388SSean Hefty cma_modify_qp_err(id_priv); 43038094ba0aSLeon Romanovsky rdma_reject(id, NULL, 0, IB_CM_REJ_CONSUMER_DEFINED); 4304e51060f0SSean Hefty return ret; 4305e51060f0SSean Hefty } 4306b09c4d70SLeon Romanovsky EXPORT_SYMBOL(rdma_accept); 4307e51060f0SSean Hefty 4308b09c4d70SLeon Romanovsky int rdma_accept_ece(struct rdma_cm_id *id, struct rdma_conn_param *conn_param, 4309b09c4d70SLeon Romanovsky struct rdma_ucm_ece *ece) 43100cb15372SLeon Romanovsky { 43110cb15372SLeon Romanovsky struct rdma_id_private *id_priv = 43120cb15372SLeon Romanovsky container_of(id, struct rdma_id_private, id); 43130cb15372SLeon Romanovsky 43140cb15372SLeon Romanovsky id_priv->ece.vendor_id = ece->vendor_id; 43150cb15372SLeon Romanovsky id_priv->ece.attr_mod = ece->attr_mod; 43160cb15372SLeon Romanovsky 4317b09c4d70SLeon Romanovsky return rdma_accept(id, conn_param); 43180cb15372SLeon Romanovsky } 4319b09c4d70SLeon Romanovsky EXPORT_SYMBOL(rdma_accept_ece); 43200cb15372SLeon Romanovsky 4321d114c6feSJason Gunthorpe void rdma_lock_handler(struct rdma_cm_id *id) 4322d114c6feSJason Gunthorpe { 4323d114c6feSJason Gunthorpe struct rdma_id_private *id_priv = 4324d114c6feSJason Gunthorpe container_of(id, struct rdma_id_private, id); 4325d114c6feSJason Gunthorpe 4326d114c6feSJason Gunthorpe mutex_lock(&id_priv->handler_mutex); 4327d114c6feSJason Gunthorpe } 4328d114c6feSJason Gunthorpe EXPORT_SYMBOL(rdma_lock_handler); 4329d114c6feSJason Gunthorpe 4330d114c6feSJason Gunthorpe void rdma_unlock_handler(struct rdma_cm_id *id) 4331d114c6feSJason Gunthorpe { 4332d114c6feSJason Gunthorpe struct rdma_id_private *id_priv = 4333d114c6feSJason Gunthorpe container_of(id, struct rdma_id_private, id); 4334d114c6feSJason Gunthorpe 4335d114c6feSJason Gunthorpe mutex_unlock(&id_priv->handler_mutex); 4336d114c6feSJason Gunthorpe } 4337d114c6feSJason Gunthorpe EXPORT_SYMBOL(rdma_unlock_handler); 43380fe313b0SSean Hefty 43390fe313b0SSean Hefty int rdma_notify(struct rdma_cm_id *id, enum ib_event_type event) 43400fe313b0SSean Hefty { 4341e51060f0SSean Hefty struct rdma_id_private *id_priv; 4342e51060f0SSean Hefty int ret; 4343e51060f0SSean Hefty 4344e51060f0SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 4345e51060f0SSean Hefty if (!id_priv->cm_id.ib) 4346e51060f0SSean Hefty return -EINVAL; 4347e51060f0SSean Hefty 43480c9361fcSJack Morgenstein switch (id->device->node_type) { 4349e51060f0SSean Hefty case RDMA_NODE_IB_CA: 4350e51060f0SSean Hefty ret = ib_cm_notify(id_priv->cm_id.ib, event); 435172219ceaSMichael Wang break; 4352ed999f82SChuck Lever default: 43535c438135SSean Hefty ret = 0; 4354e51060f0SSean Hefty break; 4355ed999f82SChuck Lever } 4356ed999f82SChuck Lever return ret; 4357628e5f6dSSean Hefty } 4358628e5f6dSSean Hefty EXPORT_SYMBOL(rdma_notify); 4359628e5f6dSSean Hefty 4360ed999f82SChuck Lever int rdma_reject(struct rdma_cm_id *id, const void *private_data, 43618094ba0aSLeon Romanovsky u8 private_data_len, u8 reason) 4362e51060f0SSean Hefty { 4363e51060f0SSean Hefty struct rdma_id_private *id_priv; 436407ebafbaSTom Tucker int ret; 436507ebafbaSTom Tucker 436607ebafbaSTom Tucker id_priv = container_of(id, struct rdma_id_private, id); 436707ebafbaSTom Tucker if (!id_priv->cm_id.ib) 4368e51060f0SSean Hefty return -EINVAL; 4369e51060f0SSean Hefty 4370e51060f0SSean Hefty if (rdma_cap_ib_cm(id->device, id->port_num)) { 4371e51060f0SSean Hefty if (id->qp_type == IB_QPT_UD) { 4372e51060f0SSean Hefty ret = cma_send_sidr_rep(id_priv, IB_SIDR_REJECT, 0, 4373e51060f0SSean Hefty private_data, private_data_len); 4374e51060f0SSean Hefty } else { 4375e51060f0SSean Hefty trace_cm_send_rej(id_priv); 43768094ba0aSLeon Romanovsky ret = ib_send_cm_rej(id_priv->cm_id.ib, reason, NULL, 0, 43778094ba0aSLeon Romanovsky private_data, private_data_len); 4378e51060f0SSean Hefty } 437904215330SMichael Wang } else if (rdma_cap_iw_cm(id->device, id->port_num)) { 4380e51060f0SSean Hefty ret = iw_cm_reject(id_priv->cm_id.iw, 4381e51060f0SSean Hefty private_data, private_data_len); 438221655afcSMichael Wang } else 4383e51060f0SSean Hefty ret = -ENOSYS; 438421655afcSMichael Wang 4385e51060f0SSean Hefty return ret; 4386e51060f0SSean Hefty } 4387e51060f0SSean Hefty EXPORT_SYMBOL(rdma_reject); 4388e51060f0SSean Hefty 4389e51060f0SSean Hefty int rdma_disconnect(struct rdma_cm_id *id) 4390e51060f0SSean Hefty { 4391e51060f0SSean Hefty struct rdma_id_private *id_priv; 4392e51060f0SSean Hefty int ret; 4393e51060f0SSean Hefty 4394e51060f0SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 43950c9361fcSJack Morgenstein if (!id_priv->cm_id.ib) 4396e51060f0SSean Hefty return -EINVAL; 4397e51060f0SSean Hefty 439872219ceaSMichael Wang if (rdma_cap_ib_cm(id->device, id->port_num)) { 4399c5483388SSean Hefty ret = cma_modify_qp_err(id_priv); 4400e51060f0SSean Hefty if (ret) 4401e51060f0SSean Hefty goto out; 4402e51060f0SSean Hefty /* Initiate or respond to a disconnect. */ 4403ed999f82SChuck Lever trace_cm_disconnect(id_priv); 4404ed999f82SChuck Lever if (ib_send_cm_dreq(id_priv->cm_id.ib, NULL, 0)) { 4405ed999f82SChuck Lever if (!ib_send_cm_drep(id_priv->cm_id.ib, NULL, 0)) 4406ed999f82SChuck Lever trace_cm_sent_drep(id_priv); 4407ed999f82SChuck Lever } else { 4408ed999f82SChuck Lever trace_cm_sent_dreq(id_priv); 4409ed999f82SChuck Lever } 441004215330SMichael Wang } else if (rdma_cap_iw_cm(id->device, id->port_num)) { 441107ebafbaSTom Tucker ret = iw_cm_disconnect(id_priv->cm_id.iw, 0); 441221655afcSMichael Wang } else 441307ebafbaSTom Tucker ret = -EINVAL; 441421655afcSMichael Wang 4415e51060f0SSean Hefty out: 4416e51060f0SSean Hefty return ret; 4417e51060f0SSean Hefty } 4418e51060f0SSean Hefty EXPORT_SYMBOL(rdma_disconnect); 4419e51060f0SSean Hefty 4420b5de0c60SJason Gunthorpe static void cma_make_mc_event(int status, struct rdma_id_private *id_priv, 4421b5de0c60SJason Gunthorpe struct ib_sa_multicast *multicast, 4422b5de0c60SJason Gunthorpe struct rdma_cm_event *event, 4423b5de0c60SJason Gunthorpe struct cma_multicast *mc) 4424c8f6a362SSean Hefty { 4425b5de0c60SJason Gunthorpe struct rdma_dev_addr *dev_addr; 4426b5de0c60SJason Gunthorpe enum ib_gid_type gid_type; 4427b5de0c60SJason Gunthorpe struct net_device *ndev; 4428c8f6a362SSean Hefty 44295c438135SSean Hefty if (!status) 44305c438135SSean Hefty status = cma_set_qkey(id_priv, be32_to_cpu(multicast->rec.qkey)); 4431498683c6SMoni Shoua else 4432498683c6SMoni Shoua pr_debug_ratelimited("RDMA CM: MULTICAST_ERROR: failed to join multicast. status %d\n", 4433498683c6SMoni Shoua status); 4434bee3c3c9SMoni Shoua 4435b5de0c60SJason Gunthorpe event->status = status; 4436b5de0c60SJason Gunthorpe event->param.ud.private_data = mc->context; 4437b5de0c60SJason Gunthorpe if (status) { 4438b5de0c60SJason Gunthorpe event->event = RDMA_CM_EVENT_MULTICAST_ERROR; 4439b5de0c60SJason Gunthorpe return; 444046ea5061SSean Hefty } 4441c8f6a362SSean Hefty 4442b5de0c60SJason Gunthorpe dev_addr = &id_priv->id.route.addr.dev_addr; 4443b5de0c60SJason Gunthorpe ndev = dev_get_by_index(dev_addr->net, dev_addr->bound_dev_if); 4444b5de0c60SJason Gunthorpe gid_type = 4445b5de0c60SJason Gunthorpe id_priv->cma_dev 4446b5de0c60SJason Gunthorpe ->default_gid_type[id_priv->id.port_num - 4447b5de0c60SJason Gunthorpe rdma_start_port( 4448b5de0c60SJason Gunthorpe id_priv->cma_dev->device)]; 4449c8f6a362SSean Hefty 4450b5de0c60SJason Gunthorpe event->event = RDMA_CM_EVENT_MULTICAST_JOIN; 4451b5de0c60SJason Gunthorpe if (ib_init_ah_from_mcmember(id_priv->id.device, id_priv->id.port_num, 4452b5de0c60SJason Gunthorpe &multicast->rec, ndev, gid_type, 4453b5de0c60SJason Gunthorpe &event->param.ud.ah_attr)) { 4454b5de0c60SJason Gunthorpe event->event = RDMA_CM_EVENT_MULTICAST_ERROR; 4455b5de0c60SJason Gunthorpe goto out; 4456b5de0c60SJason Gunthorpe } 44576d337179SParav Pandit 4458b5de0c60SJason Gunthorpe event->param.ud.qp_num = 0xFFFFFF; 4459b5de0c60SJason Gunthorpe event->param.ud.qkey = be32_to_cpu(multicast->rec.qkey); 4460b5de0c60SJason Gunthorpe 4461b5de0c60SJason Gunthorpe out: 4462bee3c3c9SMoni Shoua if (ndev) 4463bee3c3c9SMoni Shoua dev_put(ndev); 4464b5de0c60SJason Gunthorpe } 4465c8f6a362SSean Hefty 4466b5de0c60SJason Gunthorpe static int cma_ib_mc_handler(int status, struct ib_sa_multicast *multicast) 4467b5de0c60SJason Gunthorpe { 4468b5de0c60SJason Gunthorpe struct cma_multicast *mc = multicast->context; 4469b5de0c60SJason Gunthorpe struct rdma_id_private *id_priv = mc->id_priv; 4470b5de0c60SJason Gunthorpe struct rdma_cm_event event = {}; 4471b5de0c60SJason Gunthorpe int ret = 0; 4472b5de0c60SJason Gunthorpe 4473b5de0c60SJason Gunthorpe mutex_lock(&id_priv->handler_mutex); 4474b5de0c60SJason Gunthorpe if (READ_ONCE(id_priv->state) == RDMA_CM_DEVICE_REMOVAL || 4475b5de0c60SJason Gunthorpe READ_ONCE(id_priv->state) == RDMA_CM_DESTROYING) 4476b5de0c60SJason Gunthorpe goto out; 4477b5de0c60SJason Gunthorpe 4478b5de0c60SJason Gunthorpe cma_make_mc_event(status, id_priv, multicast, &event, mc); 4479ed999f82SChuck Lever ret = cma_cm_event_handler(id_priv, &event); 4480f685c195SParav Pandit rdma_destroy_ah_attr(&event.param.ud.ah_attr); 4481c8f6a362SSean Hefty if (ret) { 4482f6a9d47aSJason Gunthorpe destroy_id_handler_unlock(id_priv); 4483c8f6a362SSean Hefty return 0; 4484c8f6a362SSean Hefty } 44858aa08602SSean Hefty 448637e07cdaSBart Van Assche out: 4487de910bd9SOr Gerlitz mutex_unlock(&id_priv->handler_mutex); 4488c8f6a362SSean Hefty return 0; 4489c8f6a362SSean Hefty } 4490c8f6a362SSean Hefty 4491c8f6a362SSean Hefty static void cma_set_mgid(struct rdma_id_private *id_priv, 4492c8f6a362SSean Hefty struct sockaddr *addr, union ib_gid *mgid) 4493c8f6a362SSean Hefty { 4494c8f6a362SSean Hefty unsigned char mc_map[MAX_ADDR_LEN]; 4495c8f6a362SSean Hefty struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 4496c8f6a362SSean Hefty struct sockaddr_in *sin = (struct sockaddr_in *) addr; 4497c8f6a362SSean Hefty struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *) addr; 4498c8f6a362SSean Hefty 4499c8f6a362SSean Hefty if (cma_any_addr(addr)) { 4500c8f6a362SSean Hefty memset(mgid, 0, sizeof *mgid); 4501c8f6a362SSean Hefty } else if ((addr->sa_family == AF_INET6) && 45021c9b2819SJason Gunthorpe ((be32_to_cpu(sin6->sin6_addr.s6_addr32[0]) & 0xFFF0FFFF) == 4503c8f6a362SSean Hefty 0xFF10A01B)) { 4504c8f6a362SSean Hefty /* IPv6 address is an SA assigned MGID. */ 4505c8f6a362SSean Hefty memcpy(mgid, &sin6->sin6_addr, sizeof *mgid); 45065bc2b7b3SSean Hefty } else if (addr->sa_family == AF_IB) { 45075bc2b7b3SSean Hefty memcpy(mgid, &((struct sockaddr_ib *) addr)->sib_addr, sizeof *mgid); 4508076dd53bSVarsha Rao } else if (addr->sa_family == AF_INET6) { 4509e2e62697SJason Gunthorpe ipv6_ib_mc_map(&sin6->sin6_addr, dev_addr->broadcast, mc_map); 4510e2e62697SJason Gunthorpe if (id_priv->id.ps == RDMA_PS_UDP) 4511e2e62697SJason Gunthorpe mc_map[7] = 0x01; /* Use RDMA CM signature */ 4512e2e62697SJason Gunthorpe *mgid = *(union ib_gid *) (mc_map + 4); 4513c8f6a362SSean Hefty } else { 4514a9e527e3SRolf Manderscheid ip_ib_mc_map(sin->sin_addr.s_addr, dev_addr->broadcast, mc_map); 4515c8f6a362SSean Hefty if (id_priv->id.ps == RDMA_PS_UDP) 4516c8f6a362SSean Hefty mc_map[7] = 0x01; /* Use RDMA CM signature */ 4517c8f6a362SSean Hefty *mgid = *(union ib_gid *) (mc_map + 4); 4518c8f6a362SSean Hefty } 4519c8f6a362SSean Hefty } 4520c8f6a362SSean Hefty 4521c8f6a362SSean Hefty static int cma_join_ib_multicast(struct rdma_id_private *id_priv, 4522c8f6a362SSean Hefty struct cma_multicast *mc) 4523c8f6a362SSean Hefty { 4524c8f6a362SSean Hefty struct ib_sa_mcmember_rec rec; 4525c8f6a362SSean Hefty struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 4526c8f6a362SSean Hefty ib_sa_comp_mask comp_mask; 4527c8f6a362SSean Hefty int ret; 4528c8f6a362SSean Hefty 4529c8f6a362SSean Hefty ib_addr_get_mgid(dev_addr, &rec.mgid); 4530c8f6a362SSean Hefty ret = ib_sa_get_mcmember_rec(id_priv->id.device, id_priv->id.port_num, 4531c8f6a362SSean Hefty &rec.mgid, &rec); 4532c8f6a362SSean Hefty if (ret) 4533c8f6a362SSean Hefty return ret; 4534c8f6a362SSean Hefty 45355bc2b7b3SSean Hefty ret = cma_set_qkey(id_priv, 0); 45365bc2b7b3SSean Hefty if (ret) 45375bc2b7b3SSean Hefty return ret; 45385bc2b7b3SSean Hefty 45393f446754SRoland Dreier cma_set_mgid(id_priv, (struct sockaddr *) &mc->addr, &rec.mgid); 45405bc2b7b3SSean Hefty rec.qkey = cpu_to_be32(id_priv->qkey); 45416f8372b6SSean Hefty rdma_addr_get_sgid(dev_addr, &rec.port_gid); 4542c8f6a362SSean Hefty rec.pkey = cpu_to_be16(ib_addr_get_pkey(dev_addr)); 4543ab15c95aSAlex Vesker rec.join_state = mc->join_state; 4544ab15c95aSAlex Vesker 4545ee1c60b1SDasaratharaman Chandramouli if ((rec.join_state == BIT(SENDONLY_FULLMEMBER_JOIN)) && 4546ee1c60b1SDasaratharaman Chandramouli (!ib_sa_sendonly_fullmem_support(&sa_client, 4547ee1c60b1SDasaratharaman Chandramouli id_priv->id.device, 4548ee1c60b1SDasaratharaman Chandramouli id_priv->id.port_num))) { 454943c7c851SJason Gunthorpe dev_warn( 455043c7c851SJason Gunthorpe &id_priv->id.device->dev, 455143c7c851SJason Gunthorpe "RDMA CM: port %u Unable to multicast join: SM doesn't support Send Only Full Member option\n", 455243c7c851SJason Gunthorpe id_priv->id.port_num); 4553ab15c95aSAlex Vesker return -EOPNOTSUPP; 4554ab15c95aSAlex Vesker } 4555c8f6a362SSean Hefty 4556c8f6a362SSean Hefty comp_mask = IB_SA_MCMEMBER_REC_MGID | IB_SA_MCMEMBER_REC_PORT_GID | 4557c8f6a362SSean Hefty IB_SA_MCMEMBER_REC_PKEY | IB_SA_MCMEMBER_REC_JOIN_STATE | 4558c8f6a362SSean Hefty IB_SA_MCMEMBER_REC_QKEY | IB_SA_MCMEMBER_REC_SL | 4559c8f6a362SSean Hefty IB_SA_MCMEMBER_REC_FLOW_LABEL | 4560c8f6a362SSean Hefty IB_SA_MCMEMBER_REC_TRAFFIC_CLASS; 4561c8f6a362SSean Hefty 456284adeee9SYossi Etigin if (id_priv->id.ps == RDMA_PS_IPOIB) 456384adeee9SYossi Etigin comp_mask |= IB_SA_MCMEMBER_REC_RATE | 45642a22fb8cSDotan Barak IB_SA_MCMEMBER_REC_RATE_SELECTOR | 45652a22fb8cSDotan Barak IB_SA_MCMEMBER_REC_MTU_SELECTOR | 45662a22fb8cSDotan Barak IB_SA_MCMEMBER_REC_MTU | 45672a22fb8cSDotan Barak IB_SA_MCMEMBER_REC_HOP_LIMIT; 456884adeee9SYossi Etigin 4569b5de0c60SJason Gunthorpe mc->sa_mc = ib_sa_join_multicast(&sa_client, id_priv->id.device, 4570b5de0c60SJason Gunthorpe id_priv->id.port_num, &rec, comp_mask, 4571b5de0c60SJason Gunthorpe GFP_KERNEL, cma_ib_mc_handler, mc); 4572b5de0c60SJason Gunthorpe return PTR_ERR_OR_ZERO(mc->sa_mc); 45733c86aa70SEli Cohen } 45743c86aa70SEli Cohen 4575be1d325aSNoa Osherovich static void cma_iboe_set_mgid(struct sockaddr *addr, union ib_gid *mgid, 4576be1d325aSNoa Osherovich enum ib_gid_type gid_type) 45773c86aa70SEli Cohen { 45783c86aa70SEli Cohen struct sockaddr_in *sin = (struct sockaddr_in *)addr; 45793c86aa70SEli Cohen struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)addr; 45803c86aa70SEli Cohen 45813c86aa70SEli Cohen if (cma_any_addr(addr)) { 45823c86aa70SEli Cohen memset(mgid, 0, sizeof *mgid); 45833c86aa70SEli Cohen } else if (addr->sa_family == AF_INET6) { 45843c86aa70SEli Cohen memcpy(mgid, &sin6->sin6_addr, sizeof *mgid); 45853c86aa70SEli Cohen } else { 45865c181bdaSParav Pandit mgid->raw[0] = 45875c181bdaSParav Pandit (gid_type == IB_GID_TYPE_ROCE_UDP_ENCAP) ? 0 : 0xff; 45885c181bdaSParav Pandit mgid->raw[1] = 45895c181bdaSParav Pandit (gid_type == IB_GID_TYPE_ROCE_UDP_ENCAP) ? 0 : 0x0e; 45903c86aa70SEli Cohen mgid->raw[2] = 0; 45913c86aa70SEli Cohen mgid->raw[3] = 0; 45923c86aa70SEli Cohen mgid->raw[4] = 0; 45933c86aa70SEli Cohen mgid->raw[5] = 0; 45943c86aa70SEli Cohen mgid->raw[6] = 0; 45953c86aa70SEli Cohen mgid->raw[7] = 0; 45963c86aa70SEli Cohen mgid->raw[8] = 0; 45973c86aa70SEli Cohen mgid->raw[9] = 0; 45983c86aa70SEli Cohen mgid->raw[10] = 0xff; 45993c86aa70SEli Cohen mgid->raw[11] = 0xff; 46003c86aa70SEli Cohen *(__be32 *)(&mgid->raw[12]) = sin->sin_addr.s_addr; 46013c86aa70SEli Cohen } 46023c86aa70SEli Cohen } 46033c86aa70SEli Cohen 46043c86aa70SEli Cohen static int cma_iboe_join_multicast(struct rdma_id_private *id_priv, 46053c86aa70SEli Cohen struct cma_multicast *mc) 46063c86aa70SEli Cohen { 4607b5de0c60SJason Gunthorpe struct cma_work *work; 46083c86aa70SEli Cohen struct rdma_dev_addr *dev_addr = &id_priv->id.route.addr.dev_addr; 4609bee3c3c9SMoni Shoua int err = 0; 46103c86aa70SEli Cohen struct sockaddr *addr = (struct sockaddr *)&mc->addr; 46113c86aa70SEli Cohen struct net_device *ndev = NULL; 4612b5de0c60SJason Gunthorpe struct ib_sa_multicast ib; 4613bee3c3c9SMoni Shoua enum ib_gid_type gid_type; 4614ab15c95aSAlex Vesker bool send_only; 4615ab15c95aSAlex Vesker 4616ab15c95aSAlex Vesker send_only = mc->join_state == BIT(SENDONLY_FULLMEMBER_JOIN); 46173c86aa70SEli Cohen 4618b5de0c60SJason Gunthorpe if (cma_zero_addr(addr)) 46193c86aa70SEli Cohen return -EINVAL; 46203c86aa70SEli Cohen 46213c86aa70SEli Cohen work = kzalloc(sizeof *work, GFP_KERNEL); 46223c86aa70SEli Cohen if (!work) 46233c86aa70SEli Cohen return -ENOMEM; 46243c86aa70SEli Cohen 4625be1d325aSNoa Osherovich gid_type = id_priv->cma_dev->default_gid_type[id_priv->id.port_num - 4626be1d325aSNoa Osherovich rdma_start_port(id_priv->cma_dev->device)]; 4627b5de0c60SJason Gunthorpe cma_iboe_set_mgid(addr, &ib.rec.mgid, gid_type); 46283c86aa70SEli Cohen 4629b5de0c60SJason Gunthorpe ib.rec.pkey = cpu_to_be16(0xffff); 46303c86aa70SEli Cohen if (id_priv->id.ps == RDMA_PS_UDP) 4631b5de0c60SJason Gunthorpe ib.rec.qkey = cpu_to_be32(RDMA_UDP_QKEY); 46323c86aa70SEli Cohen 46333c86aa70SEli Cohen if (dev_addr->bound_dev_if) 4634052eac6eSParav Pandit ndev = dev_get_by_index(dev_addr->net, dev_addr->bound_dev_if); 46353c86aa70SEli Cohen if (!ndev) { 46363c86aa70SEli Cohen err = -ENODEV; 4637b5de0c60SJason Gunthorpe goto err_free; 46383c86aa70SEli Cohen } 4639b5de0c60SJason Gunthorpe ib.rec.rate = iboe_get_rate(ndev); 4640b5de0c60SJason Gunthorpe ib.rec.hop_limit = 1; 4641b5de0c60SJason Gunthorpe ib.rec.mtu = iboe_get_mtu(ndev->mtu); 4642bee3c3c9SMoni Shoua 4643bee3c3c9SMoni Shoua if (addr->sa_family == AF_INET) { 4644c65f6c5aSAlex Vesker if (gid_type == IB_GID_TYPE_ROCE_UDP_ENCAP) { 4645b5de0c60SJason Gunthorpe ib.rec.hop_limit = IPV6_DEFAULT_HOPLIMIT; 4646ab15c95aSAlex Vesker if (!send_only) { 4647b5de0c60SJason Gunthorpe err = cma_igmp_send(ndev, &ib.rec.mgid, 4648bee3c3c9SMoni Shoua true); 4649bee3c3c9SMoni Shoua } 4650bee3c3c9SMoni Shoua } 4651bee3c3c9SMoni Shoua } else { 4652bee3c3c9SMoni Shoua if (gid_type == IB_GID_TYPE_ROCE_UDP_ENCAP) 4653bee3c3c9SMoni Shoua err = -ENOTSUPP; 4654bee3c3c9SMoni Shoua } 46553c86aa70SEli Cohen dev_put(ndev); 4656b5de0c60SJason Gunthorpe if (err || !ib.rec.mtu) { 4657bee3c3c9SMoni Shoua if (!err) 46583c86aa70SEli Cohen err = -EINVAL; 4659b5de0c60SJason Gunthorpe goto err_free; 46603c86aa70SEli Cohen } 46617b85627bSMoni Shoua rdma_ip2gid((struct sockaddr *)&id_priv->id.route.addr.src_addr, 4662b5de0c60SJason Gunthorpe &ib.rec.port_gid); 46633c86aa70SEli Cohen work->id = id_priv; 4664b5de0c60SJason Gunthorpe INIT_WORK(&work->work, cma_work_handler); 4665b5de0c60SJason Gunthorpe cma_make_mc_event(0, id_priv, &ib, &work->event, mc); 4666b5de0c60SJason Gunthorpe /* Balances with cma_id_put() in cma_work_handler */ 4667b5de0c60SJason Gunthorpe cma_id_get(id_priv); 46683c86aa70SEli Cohen queue_work(cma_wq, &work->work); 46693c86aa70SEli Cohen return 0; 46703c86aa70SEli Cohen 4671b5de0c60SJason Gunthorpe err_free: 46723c86aa70SEli Cohen kfree(work); 46733c86aa70SEli Cohen return err; 46743c86aa70SEli Cohen } 46753c86aa70SEli Cohen 4676c8f6a362SSean Hefty int rdma_join_multicast(struct rdma_cm_id *id, struct sockaddr *addr, 4677ab15c95aSAlex Vesker u8 join_state, void *context) 4678c8f6a362SSean Hefty { 46795cfbf929SJason Gunthorpe struct rdma_id_private *id_priv = 46805cfbf929SJason Gunthorpe container_of(id, struct rdma_id_private, id); 4681c8f6a362SSean Hefty struct cma_multicast *mc; 4682c8f6a362SSean Hefty int ret; 4683c8f6a362SSean Hefty 46841bb5091dSJason Gunthorpe /* Not supported for kernel QPs */ 46851bb5091dSJason Gunthorpe if (WARN_ON(id->qp)) 46867688f2c3SLeon Romanovsky return -EINVAL; 46877688f2c3SLeon Romanovsky 46885cfbf929SJason Gunthorpe /* ULP is calling this wrong. */ 46895cfbf929SJason Gunthorpe if (!id->device || (READ_ONCE(id_priv->state) != RDMA_CM_ADDR_BOUND && 46905cfbf929SJason Gunthorpe READ_ONCE(id_priv->state) != RDMA_CM_ADDR_RESOLVED)) 4691c8f6a362SSean Hefty return -EINVAL; 4692c8f6a362SSean Hefty 4693b5de0c60SJason Gunthorpe mc = kzalloc(sizeof(*mc), GFP_KERNEL); 4694c8f6a362SSean Hefty if (!mc) 4695c8f6a362SSean Hefty return -ENOMEM; 4696c8f6a362SSean Hefty 4697ef560861SSean Hefty memcpy(&mc->addr, addr, rdma_addr_size(addr)); 4698c8f6a362SSean Hefty mc->context = context; 4699c8f6a362SSean Hefty mc->id_priv = id_priv; 4700ab15c95aSAlex Vesker mc->join_state = join_state; 4701c8f6a362SSean Hefty 47025d9fb044SIra Weiny if (rdma_protocol_roce(id->device, id->port_num)) { 47033c86aa70SEli Cohen ret = cma_iboe_join_multicast(id_priv, mc); 4704c0126915SJason Gunthorpe if (ret) 4705c0126915SJason Gunthorpe goto out_err; 4706c0126915SJason Gunthorpe } else if (rdma_cap_ib_mcast(id->device, id->port_num)) { 47075c9a5282SMichael Wang ret = cma_join_ib_multicast(id_priv, mc); 4708c0126915SJason Gunthorpe if (ret) 4709c0126915SJason Gunthorpe goto out_err; 4710c0126915SJason Gunthorpe } else { 4711c8f6a362SSean Hefty ret = -ENOSYS; 4712c0126915SJason Gunthorpe goto out_err; 4713c8f6a362SSean Hefty } 4714c0126915SJason Gunthorpe 4715c0126915SJason Gunthorpe spin_lock(&id_priv->lock); 4716c0126915SJason Gunthorpe list_add(&mc->list, &id_priv->mc_list); 4717c0126915SJason Gunthorpe spin_unlock(&id_priv->lock); 4718c0126915SJason Gunthorpe 4719c0126915SJason Gunthorpe return 0; 4720c0126915SJason Gunthorpe out_err: 4721c0126915SJason Gunthorpe kfree(mc); 4722c8f6a362SSean Hefty return ret; 4723c8f6a362SSean Hefty } 4724c8f6a362SSean Hefty EXPORT_SYMBOL(rdma_join_multicast); 4725c8f6a362SSean Hefty 4726c8f6a362SSean Hefty void rdma_leave_multicast(struct rdma_cm_id *id, struct sockaddr *addr) 4727c8f6a362SSean Hefty { 4728c8f6a362SSean Hefty struct rdma_id_private *id_priv; 4729c8f6a362SSean Hefty struct cma_multicast *mc; 4730c8f6a362SSean Hefty 4731c8f6a362SSean Hefty id_priv = container_of(id, struct rdma_id_private, id); 4732c8f6a362SSean Hefty spin_lock_irq(&id_priv->lock); 4733c8f6a362SSean Hefty list_for_each_entry(mc, &id_priv->mc_list, list) { 47343788d299SJason Gunthorpe if (memcmp(&mc->addr, addr, rdma_addr_size(addr)) != 0) 47353788d299SJason Gunthorpe continue; 4736c8f6a362SSean Hefty list_del(&mc->list); 4737c8f6a362SSean Hefty spin_unlock_irq(&id_priv->lock); 4738c8f6a362SSean Hefty 47393788d299SJason Gunthorpe WARN_ON(id_priv->cma_dev->device != id->device); 47403788d299SJason Gunthorpe destroy_mc(id_priv, mc); 4741c8f6a362SSean Hefty return; 4742c8f6a362SSean Hefty } 4743c8f6a362SSean Hefty spin_unlock_irq(&id_priv->lock); 4744c8f6a362SSean Hefty } 4745c8f6a362SSean Hefty EXPORT_SYMBOL(rdma_leave_multicast); 4746c8f6a362SSean Hefty 4747dd5bdff8SOr Gerlitz static int cma_netdev_change(struct net_device *ndev, struct rdma_id_private *id_priv) 4748dd5bdff8SOr Gerlitz { 4749dd5bdff8SOr Gerlitz struct rdma_dev_addr *dev_addr; 47507e85bcdaSJason Gunthorpe struct cma_work *work; 4751dd5bdff8SOr Gerlitz 4752dd5bdff8SOr Gerlitz dev_addr = &id_priv->id.route.addr.dev_addr; 4753dd5bdff8SOr Gerlitz 47546266ed6eSSean Hefty if ((dev_addr->bound_dev_if == ndev->ifindex) && 4755fa20105eSGuy Shapiro (net_eq(dev_net(ndev), dev_addr->net)) && 4756dd5bdff8SOr Gerlitz memcmp(dev_addr->src_dev_addr, ndev->dev_addr, ndev->addr_len)) { 4757aba25a3eSParav Pandit pr_info("RDMA CM addr change for ndev %s used by id %p\n", 4758dd5bdff8SOr Gerlitz ndev->name, &id_priv->id); 4759dd5bdff8SOr Gerlitz work = kzalloc(sizeof *work, GFP_KERNEL); 4760dd5bdff8SOr Gerlitz if (!work) 4761dd5bdff8SOr Gerlitz return -ENOMEM; 4762dd5bdff8SOr Gerlitz 47637e85bcdaSJason Gunthorpe INIT_WORK(&work->work, cma_work_handler); 4764dd5bdff8SOr Gerlitz work->id = id_priv; 4765dd5bdff8SOr Gerlitz work->event.event = RDMA_CM_EVENT_ADDR_CHANGE; 4766e368d23fSParav Pandit cma_id_get(id_priv); 4767dd5bdff8SOr Gerlitz queue_work(cma_wq, &work->work); 4768dd5bdff8SOr Gerlitz } 4769dd5bdff8SOr Gerlitz 4770dd5bdff8SOr Gerlitz return 0; 4771dd5bdff8SOr Gerlitz } 4772dd5bdff8SOr Gerlitz 4773dd5bdff8SOr Gerlitz static int cma_netdev_callback(struct notifier_block *self, unsigned long event, 4774351638e7SJiri Pirko void *ptr) 4775dd5bdff8SOr Gerlitz { 4776351638e7SJiri Pirko struct net_device *ndev = netdev_notifier_info_to_dev(ptr); 4777dd5bdff8SOr Gerlitz struct cma_device *cma_dev; 4778dd5bdff8SOr Gerlitz struct rdma_id_private *id_priv; 4779dd5bdff8SOr Gerlitz int ret = NOTIFY_DONE; 4780dd5bdff8SOr Gerlitz 4781dd5bdff8SOr Gerlitz if (event != NETDEV_BONDING_FAILOVER) 4782dd5bdff8SOr Gerlitz return NOTIFY_DONE; 4783dd5bdff8SOr Gerlitz 47843cd96fddSParav Pandit if (!netif_is_bond_master(ndev)) 4785dd5bdff8SOr Gerlitz return NOTIFY_DONE; 4786dd5bdff8SOr Gerlitz 4787dd5bdff8SOr Gerlitz mutex_lock(&lock); 4788dd5bdff8SOr Gerlitz list_for_each_entry(cma_dev, &dev_list, list) 4789dd5bdff8SOr Gerlitz list_for_each_entry(id_priv, &cma_dev->id_list, list) { 4790dd5bdff8SOr Gerlitz ret = cma_netdev_change(ndev, id_priv); 4791dd5bdff8SOr Gerlitz if (ret) 4792dd5bdff8SOr Gerlitz goto out; 4793dd5bdff8SOr Gerlitz } 4794dd5bdff8SOr Gerlitz 4795dd5bdff8SOr Gerlitz out: 4796dd5bdff8SOr Gerlitz mutex_unlock(&lock); 4797dd5bdff8SOr Gerlitz return ret; 4798dd5bdff8SOr Gerlitz } 4799dd5bdff8SOr Gerlitz 4800dd5bdff8SOr Gerlitz static struct notifier_block cma_nb = { 4801dd5bdff8SOr Gerlitz .notifier_call = cma_netdev_callback 4802dd5bdff8SOr Gerlitz }; 4803dd5bdff8SOr Gerlitz 48043647a28dSJason Gunthorpe static void cma_send_device_removal_put(struct rdma_id_private *id_priv) 4805e51060f0SSean Hefty { 48063647a28dSJason Gunthorpe struct rdma_cm_event event = { .event = RDMA_CM_EVENT_DEVICE_REMOVAL }; 4807550e5ca7SNir Muchtar enum rdma_cm_state state; 48083647a28dSJason Gunthorpe unsigned long flags; 4809e51060f0SSean Hefty 4810de910bd9SOr Gerlitz mutex_lock(&id_priv->handler_mutex); 48113647a28dSJason Gunthorpe /* Record that we want to remove the device */ 48123647a28dSJason Gunthorpe spin_lock_irqsave(&id_priv->lock, flags); 48133647a28dSJason Gunthorpe state = id_priv->state; 48143647a28dSJason Gunthorpe if (state == RDMA_CM_DESTROYING || state == RDMA_CM_DEVICE_REMOVAL) { 48153647a28dSJason Gunthorpe spin_unlock_irqrestore(&id_priv->lock, flags); 4816de910bd9SOr Gerlitz mutex_unlock(&id_priv->handler_mutex); 48173647a28dSJason Gunthorpe cma_id_put(id_priv); 48183647a28dSJason Gunthorpe return; 48193647a28dSJason Gunthorpe } 48203647a28dSJason Gunthorpe id_priv->state = RDMA_CM_DEVICE_REMOVAL; 48213647a28dSJason Gunthorpe spin_unlock_irqrestore(&id_priv->lock, flags); 48223647a28dSJason Gunthorpe 48233647a28dSJason Gunthorpe if (cma_cm_event_handler(id_priv, &event)) { 48243647a28dSJason Gunthorpe /* 48253647a28dSJason Gunthorpe * At this point the ULP promises it won't call 48263647a28dSJason Gunthorpe * rdma_destroy_id() concurrently 48273647a28dSJason Gunthorpe */ 48283647a28dSJason Gunthorpe cma_id_put(id_priv); 48293647a28dSJason Gunthorpe mutex_unlock(&id_priv->handler_mutex); 4830f6a9d47aSJason Gunthorpe trace_cm_id_destroy(id_priv); 4831f6a9d47aSJason Gunthorpe _destroy_id(id_priv, state); 48323647a28dSJason Gunthorpe return; 48333647a28dSJason Gunthorpe } 48343647a28dSJason Gunthorpe mutex_unlock(&id_priv->handler_mutex); 48353647a28dSJason Gunthorpe 48363647a28dSJason Gunthorpe /* 48373647a28dSJason Gunthorpe * If this races with destroy then the thread that first assigns state 48383647a28dSJason Gunthorpe * to a destroying does the cancel. 48393647a28dSJason Gunthorpe */ 48403647a28dSJason Gunthorpe cma_cancel_operation(id_priv, state); 48413647a28dSJason Gunthorpe cma_id_put(id_priv); 4842e51060f0SSean Hefty } 4843e51060f0SSean Hefty 4844e51060f0SSean Hefty static void cma_process_remove(struct cma_device *cma_dev) 4845e51060f0SSean Hefty { 4846e51060f0SSean Hefty mutex_lock(&lock); 4847e51060f0SSean Hefty while (!list_empty(&cma_dev->id_list)) { 48483647a28dSJason Gunthorpe struct rdma_id_private *id_priv = list_first_entry( 48493647a28dSJason Gunthorpe &cma_dev->id_list, struct rdma_id_private, list); 4850e51060f0SSean Hefty 4851d02d1f53SSean Hefty list_del(&id_priv->listen_list); 485294de178aSKrishna Kumar list_del_init(&id_priv->list); 4853e368d23fSParav Pandit cma_id_get(id_priv); 4854e51060f0SSean Hefty mutex_unlock(&lock); 4855e51060f0SSean Hefty 48563647a28dSJason Gunthorpe cma_send_device_removal_put(id_priv); 4857e51060f0SSean Hefty 4858e51060f0SSean Hefty mutex_lock(&lock); 4859e51060f0SSean Hefty } 4860e51060f0SSean Hefty mutex_unlock(&lock); 4861e51060f0SSean Hefty 48625ff8c8faSParav Pandit cma_dev_put(cma_dev); 4863e51060f0SSean Hefty wait_for_completion(&cma_dev->comp); 4864e51060f0SSean Hefty } 4865e51060f0SSean Hefty 4866c80a0c52SLeon Romanovsky static int cma_add_one(struct ib_device *device) 4867c80a0c52SLeon Romanovsky { 4868dd37d2f5SJason Gunthorpe struct rdma_id_private *to_destroy; 4869c80a0c52SLeon Romanovsky struct cma_device *cma_dev; 4870c80a0c52SLeon Romanovsky struct rdma_id_private *id_priv; 4871c80a0c52SLeon Romanovsky unsigned int i; 4872c80a0c52SLeon Romanovsky unsigned long supported_gids = 0; 4873c80a0c52SLeon Romanovsky int ret; 4874c80a0c52SLeon Romanovsky 4875c80a0c52SLeon Romanovsky cma_dev = kmalloc(sizeof(*cma_dev), GFP_KERNEL); 4876c80a0c52SLeon Romanovsky if (!cma_dev) 4877c80a0c52SLeon Romanovsky return -ENOMEM; 4878c80a0c52SLeon Romanovsky 4879c80a0c52SLeon Romanovsky cma_dev->device = device; 4880c80a0c52SLeon Romanovsky cma_dev->default_gid_type = kcalloc(device->phys_port_cnt, 4881c80a0c52SLeon Romanovsky sizeof(*cma_dev->default_gid_type), 4882c80a0c52SLeon Romanovsky GFP_KERNEL); 4883c80a0c52SLeon Romanovsky if (!cma_dev->default_gid_type) { 4884c80a0c52SLeon Romanovsky ret = -ENOMEM; 4885c80a0c52SLeon Romanovsky goto free_cma_dev; 4886c80a0c52SLeon Romanovsky } 4887c80a0c52SLeon Romanovsky 4888c80a0c52SLeon Romanovsky cma_dev->default_roce_tos = kcalloc(device->phys_port_cnt, 4889c80a0c52SLeon Romanovsky sizeof(*cma_dev->default_roce_tos), 4890c80a0c52SLeon Romanovsky GFP_KERNEL); 4891c80a0c52SLeon Romanovsky if (!cma_dev->default_roce_tos) { 4892c80a0c52SLeon Romanovsky ret = -ENOMEM; 4893c80a0c52SLeon Romanovsky goto free_gid_type; 4894c80a0c52SLeon Romanovsky } 4895c80a0c52SLeon Romanovsky 4896c80a0c52SLeon Romanovsky rdma_for_each_port (device, i) { 4897c80a0c52SLeon Romanovsky supported_gids = roce_gid_type_mask_support(device, i); 4898c80a0c52SLeon Romanovsky WARN_ON(!supported_gids); 4899c80a0c52SLeon Romanovsky if (supported_gids & (1 << CMA_PREFERRED_ROCE_GID_TYPE)) 4900c80a0c52SLeon Romanovsky cma_dev->default_gid_type[i - rdma_start_port(device)] = 4901c80a0c52SLeon Romanovsky CMA_PREFERRED_ROCE_GID_TYPE; 4902c80a0c52SLeon Romanovsky else 4903c80a0c52SLeon Romanovsky cma_dev->default_gid_type[i - rdma_start_port(device)] = 4904c80a0c52SLeon Romanovsky find_first_bit(&supported_gids, BITS_PER_LONG); 4905c80a0c52SLeon Romanovsky cma_dev->default_roce_tos[i - rdma_start_port(device)] = 0; 4906c80a0c52SLeon Romanovsky } 4907c80a0c52SLeon Romanovsky 4908c80a0c52SLeon Romanovsky init_completion(&cma_dev->comp); 4909c80a0c52SLeon Romanovsky refcount_set(&cma_dev->refcount, 1); 4910c80a0c52SLeon Romanovsky INIT_LIST_HEAD(&cma_dev->id_list); 4911c80a0c52SLeon Romanovsky ib_set_client_data(device, &cma_client, cma_dev); 4912c80a0c52SLeon Romanovsky 4913c80a0c52SLeon Romanovsky mutex_lock(&lock); 4914c80a0c52SLeon Romanovsky list_add_tail(&cma_dev->list, &dev_list); 4915c80a0c52SLeon Romanovsky list_for_each_entry(id_priv, &listen_any_list, list) { 4916dd37d2f5SJason Gunthorpe ret = cma_listen_on_dev(id_priv, cma_dev, &to_destroy); 4917c80a0c52SLeon Romanovsky if (ret) 4918c80a0c52SLeon Romanovsky goto free_listen; 4919c80a0c52SLeon Romanovsky } 4920c80a0c52SLeon Romanovsky mutex_unlock(&lock); 4921c80a0c52SLeon Romanovsky 4922c80a0c52SLeon Romanovsky trace_cm_add_one(device); 4923c80a0c52SLeon Romanovsky return 0; 4924c80a0c52SLeon Romanovsky 4925c80a0c52SLeon Romanovsky free_listen: 4926c80a0c52SLeon Romanovsky list_del(&cma_dev->list); 4927c80a0c52SLeon Romanovsky mutex_unlock(&lock); 4928c80a0c52SLeon Romanovsky 4929dd37d2f5SJason Gunthorpe /* cma_process_remove() will delete to_destroy */ 4930c80a0c52SLeon Romanovsky cma_process_remove(cma_dev); 4931c80a0c52SLeon Romanovsky kfree(cma_dev->default_roce_tos); 4932c80a0c52SLeon Romanovsky free_gid_type: 4933c80a0c52SLeon Romanovsky kfree(cma_dev->default_gid_type); 4934c80a0c52SLeon Romanovsky 4935c80a0c52SLeon Romanovsky free_cma_dev: 4936c80a0c52SLeon Romanovsky kfree(cma_dev); 4937c80a0c52SLeon Romanovsky return ret; 4938c80a0c52SLeon Romanovsky } 4939c80a0c52SLeon Romanovsky 49407c1eb45aSHaggai Eran static void cma_remove_one(struct ib_device *device, void *client_data) 4941e51060f0SSean Hefty { 49427c1eb45aSHaggai Eran struct cma_device *cma_dev = client_data; 4943e51060f0SSean Hefty 4944ed999f82SChuck Lever trace_cm_remove_one(device); 4945ed999f82SChuck Lever 4946e51060f0SSean Hefty mutex_lock(&lock); 4947e51060f0SSean Hefty list_del(&cma_dev->list); 4948e51060f0SSean Hefty mutex_unlock(&lock); 4949e51060f0SSean Hefty 4950e51060f0SSean Hefty cma_process_remove(cma_dev); 495189052d78SMajd Dibbiny kfree(cma_dev->default_roce_tos); 4952045959dbSMatan Barak kfree(cma_dev->default_gid_type); 4953e51060f0SSean Hefty kfree(cma_dev); 4954e51060f0SSean Hefty } 4955e51060f0SSean Hefty 49564be74b42SHaggai Eran static int cma_init_net(struct net *net) 49574be74b42SHaggai Eran { 49584be74b42SHaggai Eran struct cma_pernet *pernet = cma_pernet(net); 49594be74b42SHaggai Eran 496063826753SMatthew Wilcox xa_init(&pernet->tcp_ps); 496163826753SMatthew Wilcox xa_init(&pernet->udp_ps); 496263826753SMatthew Wilcox xa_init(&pernet->ipoib_ps); 496363826753SMatthew Wilcox xa_init(&pernet->ib_ps); 49644be74b42SHaggai Eran 49654be74b42SHaggai Eran return 0; 49664be74b42SHaggai Eran } 49674be74b42SHaggai Eran 49684be74b42SHaggai Eran static void cma_exit_net(struct net *net) 49694be74b42SHaggai Eran { 49704be74b42SHaggai Eran struct cma_pernet *pernet = cma_pernet(net); 49714be74b42SHaggai Eran 497263826753SMatthew Wilcox WARN_ON(!xa_empty(&pernet->tcp_ps)); 497363826753SMatthew Wilcox WARN_ON(!xa_empty(&pernet->udp_ps)); 497463826753SMatthew Wilcox WARN_ON(!xa_empty(&pernet->ipoib_ps)); 497563826753SMatthew Wilcox WARN_ON(!xa_empty(&pernet->ib_ps)); 49764be74b42SHaggai Eran } 49774be74b42SHaggai Eran 49784be74b42SHaggai Eran static struct pernet_operations cma_pernet_operations = { 49794be74b42SHaggai Eran .init = cma_init_net, 49804be74b42SHaggai Eran .exit = cma_exit_net, 49814be74b42SHaggai Eran .id = &cma_pernet_id, 49824be74b42SHaggai Eran .size = sizeof(struct cma_pernet), 49834be74b42SHaggai Eran }; 49844be74b42SHaggai Eran 4985716abb1fSPeter Huewe static int __init cma_init(void) 4986e51060f0SSean Hefty { 49875d7220e8STetsuo Handa int ret; 4988227b60f5SStephen Hemminger 498932ac9e43SJason Gunthorpe /* 499032ac9e43SJason Gunthorpe * There is a rare lock ordering dependency in cma_netdev_callback() 499132ac9e43SJason Gunthorpe * that only happens when bonding is enabled. Teach lockdep that rtnl 499232ac9e43SJason Gunthorpe * must never be nested under lock so it can find these without having 499332ac9e43SJason Gunthorpe * to test with bonding. 499432ac9e43SJason Gunthorpe */ 499532ac9e43SJason Gunthorpe if (IS_ENABLED(CONFIG_LOCKDEP)) { 499632ac9e43SJason Gunthorpe rtnl_lock(); 499732ac9e43SJason Gunthorpe mutex_lock(&lock); 499832ac9e43SJason Gunthorpe mutex_unlock(&lock); 499932ac9e43SJason Gunthorpe rtnl_unlock(); 500032ac9e43SJason Gunthorpe } 500132ac9e43SJason Gunthorpe 5002dee9acbbSBhaktipriya Shridhar cma_wq = alloc_ordered_workqueue("rdma_cm", WQ_MEM_RECLAIM); 5003e51060f0SSean Hefty if (!cma_wq) 5004e51060f0SSean Hefty return -ENOMEM; 5005e51060f0SSean Hefty 50064be74b42SHaggai Eran ret = register_pernet_subsys(&cma_pernet_operations); 50074be74b42SHaggai Eran if (ret) 50084be74b42SHaggai Eran goto err_wq; 50094be74b42SHaggai Eran 5010c1a0b23bSMichael S. Tsirkin ib_sa_register_client(&sa_client); 5011dd5bdff8SOr Gerlitz register_netdevice_notifier(&cma_nb); 5012c1a0b23bSMichael S. Tsirkin 5013e51060f0SSean Hefty ret = ib_register_client(&cma_client); 5014e51060f0SSean Hefty if (ret) 5015e51060f0SSean Hefty goto err; 5016753f618aSNir Muchtar 5017a7bfb93fSzhengbin ret = cma_configfs_init(); 5018a7bfb93fSzhengbin if (ret) 5019a7bfb93fSzhengbin goto err_ib; 5020753f618aSNir Muchtar 5021e51060f0SSean Hefty return 0; 5022e51060f0SSean Hefty 5023a7bfb93fSzhengbin err_ib: 5024a7bfb93fSzhengbin ib_unregister_client(&cma_client); 5025e51060f0SSean Hefty err: 5026dd5bdff8SOr Gerlitz unregister_netdevice_notifier(&cma_nb); 5027c1a0b23bSMichael S. Tsirkin ib_sa_unregister_client(&sa_client); 502844a7b675SChuhong Yuan unregister_pernet_subsys(&cma_pernet_operations); 50294be74b42SHaggai Eran err_wq: 5030e51060f0SSean Hefty destroy_workqueue(cma_wq); 5031e51060f0SSean Hefty return ret; 5032e51060f0SSean Hefty } 5033e51060f0SSean Hefty 5034716abb1fSPeter Huewe static void __exit cma_cleanup(void) 5035e51060f0SSean Hefty { 5036045959dbSMatan Barak cma_configfs_exit(); 5037e51060f0SSean Hefty ib_unregister_client(&cma_client); 5038dd5bdff8SOr Gerlitz unregister_netdevice_notifier(&cma_nb); 5039c1a0b23bSMichael S. Tsirkin ib_sa_unregister_client(&sa_client); 50404be74b42SHaggai Eran unregister_pernet_subsys(&cma_pernet_operations); 5041e51060f0SSean Hefty destroy_workqueue(cma_wq); 5042e51060f0SSean Hefty } 5043e51060f0SSean Hefty 5044e51060f0SSean Hefty module_init(cma_init); 5045e51060f0SSean Hefty module_exit(cma_cleanup); 5046