xref: /OK3568_Linux_fs/kernel/net/rds/ib_cm.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Copyright (c) 2006, 2019 Oracle and/or its affiliates. All rights reserved.
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * This software is available to you under a choice of one of two
5*4882a593Smuzhiyun  * licenses.  You may choose to be licensed under the terms of the GNU
6*4882a593Smuzhiyun  * General Public License (GPL) Version 2, available from the file
7*4882a593Smuzhiyun  * COPYING in the main directory of this source tree, or the
8*4882a593Smuzhiyun  * OpenIB.org BSD license below:
9*4882a593Smuzhiyun  *
10*4882a593Smuzhiyun  *     Redistribution and use in source and binary forms, with or
11*4882a593Smuzhiyun  *     without modification, are permitted provided that the following
12*4882a593Smuzhiyun  *     conditions are met:
13*4882a593Smuzhiyun  *
14*4882a593Smuzhiyun  *      - Redistributions of source code must retain the above
15*4882a593Smuzhiyun  *        copyright notice, this list of conditions and the following
16*4882a593Smuzhiyun  *        disclaimer.
17*4882a593Smuzhiyun  *
18*4882a593Smuzhiyun  *      - Redistributions in binary form must reproduce the above
19*4882a593Smuzhiyun  *        copyright notice, this list of conditions and the following
20*4882a593Smuzhiyun  *        disclaimer in the documentation and/or other materials
21*4882a593Smuzhiyun  *        provided with the distribution.
22*4882a593Smuzhiyun  *
23*4882a593Smuzhiyun  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24*4882a593Smuzhiyun  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25*4882a593Smuzhiyun  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26*4882a593Smuzhiyun  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27*4882a593Smuzhiyun  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28*4882a593Smuzhiyun  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29*4882a593Smuzhiyun  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30*4882a593Smuzhiyun  * SOFTWARE.
31*4882a593Smuzhiyun  *
32*4882a593Smuzhiyun  */
33*4882a593Smuzhiyun #include <linux/kernel.h>
34*4882a593Smuzhiyun #include <linux/in.h>
35*4882a593Smuzhiyun #include <linux/slab.h>
36*4882a593Smuzhiyun #include <linux/vmalloc.h>
37*4882a593Smuzhiyun #include <linux/ratelimit.h>
38*4882a593Smuzhiyun #include <net/addrconf.h>
39*4882a593Smuzhiyun #include <rdma/ib_cm.h>
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun #include "rds_single_path.h"
42*4882a593Smuzhiyun #include "rds.h"
43*4882a593Smuzhiyun #include "ib.h"
44*4882a593Smuzhiyun #include "ib_mr.h"
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun /*
47*4882a593Smuzhiyun  * Set the selected protocol version
48*4882a593Smuzhiyun  */
rds_ib_set_protocol(struct rds_connection * conn,unsigned int version)49*4882a593Smuzhiyun static void rds_ib_set_protocol(struct rds_connection *conn, unsigned int version)
50*4882a593Smuzhiyun {
51*4882a593Smuzhiyun 	conn->c_version = version;
52*4882a593Smuzhiyun }
53*4882a593Smuzhiyun 
54*4882a593Smuzhiyun /*
55*4882a593Smuzhiyun  * Set up flow control
56*4882a593Smuzhiyun  */
rds_ib_set_flow_control(struct rds_connection * conn,u32 credits)57*4882a593Smuzhiyun static void rds_ib_set_flow_control(struct rds_connection *conn, u32 credits)
58*4882a593Smuzhiyun {
59*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun 	if (rds_ib_sysctl_flow_control && credits != 0) {
62*4882a593Smuzhiyun 		/* We're doing flow control */
63*4882a593Smuzhiyun 		ic->i_flowctl = 1;
64*4882a593Smuzhiyun 		rds_ib_send_add_credits(conn, credits);
65*4882a593Smuzhiyun 	} else {
66*4882a593Smuzhiyun 		ic->i_flowctl = 0;
67*4882a593Smuzhiyun 	}
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun /*
71*4882a593Smuzhiyun  * Tune RNR behavior. Without flow control, we use a rather
72*4882a593Smuzhiyun  * low timeout, but not the absolute minimum - this should
73*4882a593Smuzhiyun  * be tunable.
74*4882a593Smuzhiyun  *
75*4882a593Smuzhiyun  * We already set the RNR retry count to 7 (which is the
76*4882a593Smuzhiyun  * smallest infinite number :-) above.
77*4882a593Smuzhiyun  * If flow control is off, we want to change this back to 0
78*4882a593Smuzhiyun  * so that we learn quickly when our credit accounting is
79*4882a593Smuzhiyun  * buggy.
80*4882a593Smuzhiyun  *
81*4882a593Smuzhiyun  * Caller passes in a qp_attr pointer - don't waste stack spacv
82*4882a593Smuzhiyun  * by allocation this twice.
83*4882a593Smuzhiyun  */
84*4882a593Smuzhiyun static void
rds_ib_tune_rnr(struct rds_ib_connection * ic,struct ib_qp_attr * attr)85*4882a593Smuzhiyun rds_ib_tune_rnr(struct rds_ib_connection *ic, struct ib_qp_attr *attr)
86*4882a593Smuzhiyun {
87*4882a593Smuzhiyun 	int ret;
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun 	attr->min_rnr_timer = IB_RNR_TIMER_000_32;
90*4882a593Smuzhiyun 	ret = ib_modify_qp(ic->i_cm_id->qp, attr, IB_QP_MIN_RNR_TIMER);
91*4882a593Smuzhiyun 	if (ret)
92*4882a593Smuzhiyun 		printk(KERN_NOTICE "ib_modify_qp(IB_QP_MIN_RNR_TIMER): err=%d\n", -ret);
93*4882a593Smuzhiyun }
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun /*
96*4882a593Smuzhiyun  * Connection established.
97*4882a593Smuzhiyun  * We get here for both outgoing and incoming connection.
98*4882a593Smuzhiyun  */
rds_ib_cm_connect_complete(struct rds_connection * conn,struct rdma_cm_event * event)99*4882a593Smuzhiyun void rds_ib_cm_connect_complete(struct rds_connection *conn, struct rdma_cm_event *event)
100*4882a593Smuzhiyun {
101*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
102*4882a593Smuzhiyun 	const union rds_ib_conn_priv *dp = NULL;
103*4882a593Smuzhiyun 	struct ib_qp_attr qp_attr;
104*4882a593Smuzhiyun 	__be64 ack_seq = 0;
105*4882a593Smuzhiyun 	__be32 credit = 0;
106*4882a593Smuzhiyun 	u8 major = 0;
107*4882a593Smuzhiyun 	u8 minor = 0;
108*4882a593Smuzhiyun 	int err;
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 	dp = event->param.conn.private_data;
111*4882a593Smuzhiyun 	if (conn->c_isv6) {
112*4882a593Smuzhiyun 		if (event->param.conn.private_data_len >=
113*4882a593Smuzhiyun 		    sizeof(struct rds6_ib_connect_private)) {
114*4882a593Smuzhiyun 			major = dp->ricp_v6.dp_protocol_major;
115*4882a593Smuzhiyun 			minor = dp->ricp_v6.dp_protocol_minor;
116*4882a593Smuzhiyun 			credit = dp->ricp_v6.dp_credit;
117*4882a593Smuzhiyun 			/* dp structure start is not guaranteed to be 8 bytes
118*4882a593Smuzhiyun 			 * aligned.  Since dp_ack_seq is 64-bit extended load
119*4882a593Smuzhiyun 			 * operations can be used so go through get_unaligned
120*4882a593Smuzhiyun 			 * to avoid unaligned errors.
121*4882a593Smuzhiyun 			 */
122*4882a593Smuzhiyun 			ack_seq = get_unaligned(&dp->ricp_v6.dp_ack_seq);
123*4882a593Smuzhiyun 		}
124*4882a593Smuzhiyun 	} else if (event->param.conn.private_data_len >=
125*4882a593Smuzhiyun 		   sizeof(struct rds_ib_connect_private)) {
126*4882a593Smuzhiyun 		major = dp->ricp_v4.dp_protocol_major;
127*4882a593Smuzhiyun 		minor = dp->ricp_v4.dp_protocol_minor;
128*4882a593Smuzhiyun 		credit = dp->ricp_v4.dp_credit;
129*4882a593Smuzhiyun 		ack_seq = get_unaligned(&dp->ricp_v4.dp_ack_seq);
130*4882a593Smuzhiyun 	}
131*4882a593Smuzhiyun 
132*4882a593Smuzhiyun 	/* make sure it isn't empty data */
133*4882a593Smuzhiyun 	if (major) {
134*4882a593Smuzhiyun 		rds_ib_set_protocol(conn, RDS_PROTOCOL(major, minor));
135*4882a593Smuzhiyun 		rds_ib_set_flow_control(conn, be32_to_cpu(credit));
136*4882a593Smuzhiyun 	}
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun 	if (conn->c_version < RDS_PROTOCOL_VERSION) {
139*4882a593Smuzhiyun 		if (conn->c_version != RDS_PROTOCOL_COMPAT_VERSION) {
140*4882a593Smuzhiyun 			pr_notice("RDS/IB: Connection <%pI6c,%pI6c> version %u.%u no longer supported\n",
141*4882a593Smuzhiyun 				  &conn->c_laddr, &conn->c_faddr,
142*4882a593Smuzhiyun 				  RDS_PROTOCOL_MAJOR(conn->c_version),
143*4882a593Smuzhiyun 				  RDS_PROTOCOL_MINOR(conn->c_version));
144*4882a593Smuzhiyun 			rds_conn_destroy(conn);
145*4882a593Smuzhiyun 			return;
146*4882a593Smuzhiyun 		}
147*4882a593Smuzhiyun 	}
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun 	pr_notice("RDS/IB: %s conn connected <%pI6c,%pI6c,%d> version %u.%u%s\n",
150*4882a593Smuzhiyun 		  ic->i_active_side ? "Active" : "Passive",
151*4882a593Smuzhiyun 		  &conn->c_laddr, &conn->c_faddr, conn->c_tos,
152*4882a593Smuzhiyun 		  RDS_PROTOCOL_MAJOR(conn->c_version),
153*4882a593Smuzhiyun 		  RDS_PROTOCOL_MINOR(conn->c_version),
154*4882a593Smuzhiyun 		  ic->i_flowctl ? ", flow control" : "");
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun 	/* receive sl from the peer */
157*4882a593Smuzhiyun 	ic->i_sl = ic->i_cm_id->route.path_rec->sl;
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun 	atomic_set(&ic->i_cq_quiesce, 0);
160*4882a593Smuzhiyun 
161*4882a593Smuzhiyun 	/* Init rings and fill recv. this needs to wait until protocol
162*4882a593Smuzhiyun 	 * negotiation is complete, since ring layout is different
163*4882a593Smuzhiyun 	 * from 3.1 to 4.1.
164*4882a593Smuzhiyun 	 */
165*4882a593Smuzhiyun 	rds_ib_send_init_ring(ic);
166*4882a593Smuzhiyun 	rds_ib_recv_init_ring(ic);
167*4882a593Smuzhiyun 	/* Post receive buffers - as a side effect, this will update
168*4882a593Smuzhiyun 	 * the posted credit count. */
169*4882a593Smuzhiyun 	rds_ib_recv_refill(conn, 1, GFP_KERNEL);
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun 	/* Tune RNR behavior */
172*4882a593Smuzhiyun 	rds_ib_tune_rnr(ic, &qp_attr);
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun 	qp_attr.qp_state = IB_QPS_RTS;
175*4882a593Smuzhiyun 	err = ib_modify_qp(ic->i_cm_id->qp, &qp_attr, IB_QP_STATE);
176*4882a593Smuzhiyun 	if (err)
177*4882a593Smuzhiyun 		printk(KERN_NOTICE "ib_modify_qp(IB_QP_STATE, RTS): err=%d\n", err);
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 	/* update ib_device with this local ipaddr */
180*4882a593Smuzhiyun 	err = rds_ib_update_ipaddr(ic->rds_ibdev, &conn->c_laddr);
181*4882a593Smuzhiyun 	if (err)
182*4882a593Smuzhiyun 		printk(KERN_ERR "rds_ib_update_ipaddr failed (%d)\n",
183*4882a593Smuzhiyun 			err);
184*4882a593Smuzhiyun 
185*4882a593Smuzhiyun 	/* If the peer gave us the last packet it saw, process this as if
186*4882a593Smuzhiyun 	 * we had received a regular ACK. */
187*4882a593Smuzhiyun 	if (dp) {
188*4882a593Smuzhiyun 		if (ack_seq)
189*4882a593Smuzhiyun 			rds_send_drop_acked(conn, be64_to_cpu(ack_seq),
190*4882a593Smuzhiyun 					    NULL);
191*4882a593Smuzhiyun 	}
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 	conn->c_proposed_version = conn->c_version;
194*4882a593Smuzhiyun 	rds_connect_complete(conn);
195*4882a593Smuzhiyun }
196*4882a593Smuzhiyun 
rds_ib_cm_fill_conn_param(struct rds_connection * conn,struct rdma_conn_param * conn_param,union rds_ib_conn_priv * dp,u32 protocol_version,u32 max_responder_resources,u32 max_initiator_depth,bool isv6)197*4882a593Smuzhiyun static void rds_ib_cm_fill_conn_param(struct rds_connection *conn,
198*4882a593Smuzhiyun 				      struct rdma_conn_param *conn_param,
199*4882a593Smuzhiyun 				      union rds_ib_conn_priv *dp,
200*4882a593Smuzhiyun 				      u32 protocol_version,
201*4882a593Smuzhiyun 				      u32 max_responder_resources,
202*4882a593Smuzhiyun 				      u32 max_initiator_depth,
203*4882a593Smuzhiyun 				      bool isv6)
204*4882a593Smuzhiyun {
205*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
206*4882a593Smuzhiyun 	struct rds_ib_device *rds_ibdev = ic->rds_ibdev;
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 	memset(conn_param, 0, sizeof(struct rdma_conn_param));
209*4882a593Smuzhiyun 
210*4882a593Smuzhiyun 	conn_param->responder_resources =
211*4882a593Smuzhiyun 		min_t(u32, rds_ibdev->max_responder_resources, max_responder_resources);
212*4882a593Smuzhiyun 	conn_param->initiator_depth =
213*4882a593Smuzhiyun 		min_t(u32, rds_ibdev->max_initiator_depth, max_initiator_depth);
214*4882a593Smuzhiyun 	conn_param->retry_count = min_t(unsigned int, rds_ib_retry_count, 7);
215*4882a593Smuzhiyun 	conn_param->rnr_retry_count = 7;
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 	if (dp) {
218*4882a593Smuzhiyun 		memset(dp, 0, sizeof(*dp));
219*4882a593Smuzhiyun 		if (isv6) {
220*4882a593Smuzhiyun 			dp->ricp_v6.dp_saddr = conn->c_laddr;
221*4882a593Smuzhiyun 			dp->ricp_v6.dp_daddr = conn->c_faddr;
222*4882a593Smuzhiyun 			dp->ricp_v6.dp_protocol_major =
223*4882a593Smuzhiyun 			    RDS_PROTOCOL_MAJOR(protocol_version);
224*4882a593Smuzhiyun 			dp->ricp_v6.dp_protocol_minor =
225*4882a593Smuzhiyun 			    RDS_PROTOCOL_MINOR(protocol_version);
226*4882a593Smuzhiyun 			dp->ricp_v6.dp_protocol_minor_mask =
227*4882a593Smuzhiyun 			    cpu_to_be16(RDS_IB_SUPPORTED_PROTOCOLS);
228*4882a593Smuzhiyun 			dp->ricp_v6.dp_ack_seq =
229*4882a593Smuzhiyun 			    cpu_to_be64(rds_ib_piggyb_ack(ic));
230*4882a593Smuzhiyun 			dp->ricp_v6.dp_cmn.ricpc_dp_toss = conn->c_tos;
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 			conn_param->private_data = &dp->ricp_v6;
233*4882a593Smuzhiyun 			conn_param->private_data_len = sizeof(dp->ricp_v6);
234*4882a593Smuzhiyun 		} else {
235*4882a593Smuzhiyun 			dp->ricp_v4.dp_saddr = conn->c_laddr.s6_addr32[3];
236*4882a593Smuzhiyun 			dp->ricp_v4.dp_daddr = conn->c_faddr.s6_addr32[3];
237*4882a593Smuzhiyun 			dp->ricp_v4.dp_protocol_major =
238*4882a593Smuzhiyun 			    RDS_PROTOCOL_MAJOR(protocol_version);
239*4882a593Smuzhiyun 			dp->ricp_v4.dp_protocol_minor =
240*4882a593Smuzhiyun 			    RDS_PROTOCOL_MINOR(protocol_version);
241*4882a593Smuzhiyun 			dp->ricp_v4.dp_protocol_minor_mask =
242*4882a593Smuzhiyun 			    cpu_to_be16(RDS_IB_SUPPORTED_PROTOCOLS);
243*4882a593Smuzhiyun 			dp->ricp_v4.dp_ack_seq =
244*4882a593Smuzhiyun 			    cpu_to_be64(rds_ib_piggyb_ack(ic));
245*4882a593Smuzhiyun 			dp->ricp_v4.dp_cmn.ricpc_dp_toss = conn->c_tos;
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 			conn_param->private_data = &dp->ricp_v4;
248*4882a593Smuzhiyun 			conn_param->private_data_len = sizeof(dp->ricp_v4);
249*4882a593Smuzhiyun 		}
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 		/* Advertise flow control */
252*4882a593Smuzhiyun 		if (ic->i_flowctl) {
253*4882a593Smuzhiyun 			unsigned int credits;
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 			credits = IB_GET_POST_CREDITS
256*4882a593Smuzhiyun 				(atomic_read(&ic->i_credits));
257*4882a593Smuzhiyun 			if (isv6)
258*4882a593Smuzhiyun 				dp->ricp_v6.dp_credit = cpu_to_be32(credits);
259*4882a593Smuzhiyun 			else
260*4882a593Smuzhiyun 				dp->ricp_v4.dp_credit = cpu_to_be32(credits);
261*4882a593Smuzhiyun 			atomic_sub(IB_SET_POST_CREDITS(credits),
262*4882a593Smuzhiyun 				   &ic->i_credits);
263*4882a593Smuzhiyun 		}
264*4882a593Smuzhiyun 	}
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun 
rds_ib_cq_event_handler(struct ib_event * event,void * data)267*4882a593Smuzhiyun static void rds_ib_cq_event_handler(struct ib_event *event, void *data)
268*4882a593Smuzhiyun {
269*4882a593Smuzhiyun 	rdsdebug("event %u (%s) data %p\n",
270*4882a593Smuzhiyun 		 event->event, ib_event_msg(event->event), data);
271*4882a593Smuzhiyun }
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun /* Plucking the oldest entry from the ring can be done concurrently with
274*4882a593Smuzhiyun  * the thread refilling the ring.  Each ring operation is protected by
275*4882a593Smuzhiyun  * spinlocks and the transient state of refilling doesn't change the
276*4882a593Smuzhiyun  * recording of which entry is oldest.
277*4882a593Smuzhiyun  *
278*4882a593Smuzhiyun  * This relies on IB only calling one cq comp_handler for each cq so that
279*4882a593Smuzhiyun  * there will only be one caller of rds_recv_incoming() per RDS connection.
280*4882a593Smuzhiyun  */
rds_ib_cq_comp_handler_recv(struct ib_cq * cq,void * context)281*4882a593Smuzhiyun static void rds_ib_cq_comp_handler_recv(struct ib_cq *cq, void *context)
282*4882a593Smuzhiyun {
283*4882a593Smuzhiyun 	struct rds_connection *conn = context;
284*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	rdsdebug("conn %p cq %p\n", conn, cq);
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	rds_ib_stats_inc(s_ib_evt_handler_call);
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 	tasklet_schedule(&ic->i_recv_tasklet);
291*4882a593Smuzhiyun }
292*4882a593Smuzhiyun 
poll_scq(struct rds_ib_connection * ic,struct ib_cq * cq,struct ib_wc * wcs)293*4882a593Smuzhiyun static void poll_scq(struct rds_ib_connection *ic, struct ib_cq *cq,
294*4882a593Smuzhiyun 		     struct ib_wc *wcs)
295*4882a593Smuzhiyun {
296*4882a593Smuzhiyun 	int nr, i;
297*4882a593Smuzhiyun 	struct ib_wc *wc;
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 	while ((nr = ib_poll_cq(cq, RDS_IB_WC_MAX, wcs)) > 0) {
300*4882a593Smuzhiyun 		for (i = 0; i < nr; i++) {
301*4882a593Smuzhiyun 			wc = wcs + i;
302*4882a593Smuzhiyun 			rdsdebug("wc wr_id 0x%llx status %u byte_len %u imm_data %u\n",
303*4882a593Smuzhiyun 				 (unsigned long long)wc->wr_id, wc->status,
304*4882a593Smuzhiyun 				 wc->byte_len, be32_to_cpu(wc->ex.imm_data));
305*4882a593Smuzhiyun 
306*4882a593Smuzhiyun 			if (wc->wr_id <= ic->i_send_ring.w_nr ||
307*4882a593Smuzhiyun 			    wc->wr_id == RDS_IB_ACK_WR_ID)
308*4882a593Smuzhiyun 				rds_ib_send_cqe_handler(ic, wc);
309*4882a593Smuzhiyun 			else
310*4882a593Smuzhiyun 				rds_ib_mr_cqe_handler(ic, wc);
311*4882a593Smuzhiyun 
312*4882a593Smuzhiyun 		}
313*4882a593Smuzhiyun 	}
314*4882a593Smuzhiyun }
315*4882a593Smuzhiyun 
rds_ib_tasklet_fn_send(unsigned long data)316*4882a593Smuzhiyun static void rds_ib_tasklet_fn_send(unsigned long data)
317*4882a593Smuzhiyun {
318*4882a593Smuzhiyun 	struct rds_ib_connection *ic = (struct rds_ib_connection *)data;
319*4882a593Smuzhiyun 	struct rds_connection *conn = ic->conn;
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun 	rds_ib_stats_inc(s_ib_tasklet_call);
322*4882a593Smuzhiyun 
323*4882a593Smuzhiyun 	/* if cq has been already reaped, ignore incoming cq event */
324*4882a593Smuzhiyun 	if (atomic_read(&ic->i_cq_quiesce))
325*4882a593Smuzhiyun 		return;
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun 	poll_scq(ic, ic->i_send_cq, ic->i_send_wc);
328*4882a593Smuzhiyun 	ib_req_notify_cq(ic->i_send_cq, IB_CQ_NEXT_COMP);
329*4882a593Smuzhiyun 	poll_scq(ic, ic->i_send_cq, ic->i_send_wc);
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 	if (rds_conn_up(conn) &&
332*4882a593Smuzhiyun 	    (!test_bit(RDS_LL_SEND_FULL, &conn->c_flags) ||
333*4882a593Smuzhiyun 	    test_bit(0, &conn->c_map_queued)))
334*4882a593Smuzhiyun 		rds_send_xmit(&ic->conn->c_path[0]);
335*4882a593Smuzhiyun }
336*4882a593Smuzhiyun 
poll_rcq(struct rds_ib_connection * ic,struct ib_cq * cq,struct ib_wc * wcs,struct rds_ib_ack_state * ack_state)337*4882a593Smuzhiyun static void poll_rcq(struct rds_ib_connection *ic, struct ib_cq *cq,
338*4882a593Smuzhiyun 		     struct ib_wc *wcs,
339*4882a593Smuzhiyun 		     struct rds_ib_ack_state *ack_state)
340*4882a593Smuzhiyun {
341*4882a593Smuzhiyun 	int nr, i;
342*4882a593Smuzhiyun 	struct ib_wc *wc;
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	while ((nr = ib_poll_cq(cq, RDS_IB_WC_MAX, wcs)) > 0) {
345*4882a593Smuzhiyun 		for (i = 0; i < nr; i++) {
346*4882a593Smuzhiyun 			wc = wcs + i;
347*4882a593Smuzhiyun 			rdsdebug("wc wr_id 0x%llx status %u byte_len %u imm_data %u\n",
348*4882a593Smuzhiyun 				 (unsigned long long)wc->wr_id, wc->status,
349*4882a593Smuzhiyun 				 wc->byte_len, be32_to_cpu(wc->ex.imm_data));
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 			rds_ib_recv_cqe_handler(ic, wc, ack_state);
352*4882a593Smuzhiyun 		}
353*4882a593Smuzhiyun 	}
354*4882a593Smuzhiyun }
355*4882a593Smuzhiyun 
rds_ib_tasklet_fn_recv(unsigned long data)356*4882a593Smuzhiyun static void rds_ib_tasklet_fn_recv(unsigned long data)
357*4882a593Smuzhiyun {
358*4882a593Smuzhiyun 	struct rds_ib_connection *ic = (struct rds_ib_connection *)data;
359*4882a593Smuzhiyun 	struct rds_connection *conn = ic->conn;
360*4882a593Smuzhiyun 	struct rds_ib_device *rds_ibdev = ic->rds_ibdev;
361*4882a593Smuzhiyun 	struct rds_ib_ack_state state;
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	if (!rds_ibdev)
364*4882a593Smuzhiyun 		rds_conn_drop(conn);
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	rds_ib_stats_inc(s_ib_tasklet_call);
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun 	/* if cq has been already reaped, ignore incoming cq event */
369*4882a593Smuzhiyun 	if (atomic_read(&ic->i_cq_quiesce))
370*4882a593Smuzhiyun 		return;
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	memset(&state, 0, sizeof(state));
373*4882a593Smuzhiyun 	poll_rcq(ic, ic->i_recv_cq, ic->i_recv_wc, &state);
374*4882a593Smuzhiyun 	ib_req_notify_cq(ic->i_recv_cq, IB_CQ_SOLICITED);
375*4882a593Smuzhiyun 	poll_rcq(ic, ic->i_recv_cq, ic->i_recv_wc, &state);
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 	if (state.ack_next_valid)
378*4882a593Smuzhiyun 		rds_ib_set_ack(ic, state.ack_next, state.ack_required);
379*4882a593Smuzhiyun 	if (state.ack_recv_valid && state.ack_recv > ic->i_ack_recv) {
380*4882a593Smuzhiyun 		rds_send_drop_acked(conn, state.ack_recv, NULL);
381*4882a593Smuzhiyun 		ic->i_ack_recv = state.ack_recv;
382*4882a593Smuzhiyun 	}
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 	if (rds_conn_up(conn))
385*4882a593Smuzhiyun 		rds_ib_attempt_ack(ic);
386*4882a593Smuzhiyun }
387*4882a593Smuzhiyun 
rds_ib_qp_event_handler(struct ib_event * event,void * data)388*4882a593Smuzhiyun static void rds_ib_qp_event_handler(struct ib_event *event, void *data)
389*4882a593Smuzhiyun {
390*4882a593Smuzhiyun 	struct rds_connection *conn = data;
391*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun 	rdsdebug("conn %p ic %p event %u (%s)\n", conn, ic, event->event,
394*4882a593Smuzhiyun 		 ib_event_msg(event->event));
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 	switch (event->event) {
397*4882a593Smuzhiyun 	case IB_EVENT_COMM_EST:
398*4882a593Smuzhiyun 		rdma_notify(ic->i_cm_id, IB_EVENT_COMM_EST);
399*4882a593Smuzhiyun 		break;
400*4882a593Smuzhiyun 	default:
401*4882a593Smuzhiyun 		rdsdebug("Fatal QP Event %u (%s) - connection %pI6c->%pI6c, reconnecting\n",
402*4882a593Smuzhiyun 			 event->event, ib_event_msg(event->event),
403*4882a593Smuzhiyun 			 &conn->c_laddr, &conn->c_faddr);
404*4882a593Smuzhiyun 		rds_conn_drop(conn);
405*4882a593Smuzhiyun 		break;
406*4882a593Smuzhiyun 	}
407*4882a593Smuzhiyun }
408*4882a593Smuzhiyun 
rds_ib_cq_comp_handler_send(struct ib_cq * cq,void * context)409*4882a593Smuzhiyun static void rds_ib_cq_comp_handler_send(struct ib_cq *cq, void *context)
410*4882a593Smuzhiyun {
411*4882a593Smuzhiyun 	struct rds_connection *conn = context;
412*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun 	rdsdebug("conn %p cq %p\n", conn, cq);
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 	rds_ib_stats_inc(s_ib_evt_handler_call);
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun 	tasklet_schedule(&ic->i_send_tasklet);
419*4882a593Smuzhiyun }
420*4882a593Smuzhiyun 
ibdev_get_unused_vector(struct rds_ib_device * rds_ibdev)421*4882a593Smuzhiyun static inline int ibdev_get_unused_vector(struct rds_ib_device *rds_ibdev)
422*4882a593Smuzhiyun {
423*4882a593Smuzhiyun 	int min = rds_ibdev->vector_load[rds_ibdev->dev->num_comp_vectors - 1];
424*4882a593Smuzhiyun 	int index = rds_ibdev->dev->num_comp_vectors - 1;
425*4882a593Smuzhiyun 	int i;
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	for (i = rds_ibdev->dev->num_comp_vectors - 1; i >= 0; i--) {
428*4882a593Smuzhiyun 		if (rds_ibdev->vector_load[i] < min) {
429*4882a593Smuzhiyun 			index = i;
430*4882a593Smuzhiyun 			min = rds_ibdev->vector_load[i];
431*4882a593Smuzhiyun 		}
432*4882a593Smuzhiyun 	}
433*4882a593Smuzhiyun 
434*4882a593Smuzhiyun 	rds_ibdev->vector_load[index]++;
435*4882a593Smuzhiyun 	return index;
436*4882a593Smuzhiyun }
437*4882a593Smuzhiyun 
ibdev_put_vector(struct rds_ib_device * rds_ibdev,int index)438*4882a593Smuzhiyun static inline void ibdev_put_vector(struct rds_ib_device *rds_ibdev, int index)
439*4882a593Smuzhiyun {
440*4882a593Smuzhiyun 	rds_ibdev->vector_load[index]--;
441*4882a593Smuzhiyun }
442*4882a593Smuzhiyun 
rds_dma_hdr_free(struct ib_device * dev,struct rds_header * hdr,dma_addr_t dma_addr,enum dma_data_direction dir)443*4882a593Smuzhiyun static void rds_dma_hdr_free(struct ib_device *dev, struct rds_header *hdr,
444*4882a593Smuzhiyun 		dma_addr_t dma_addr, enum dma_data_direction dir)
445*4882a593Smuzhiyun {
446*4882a593Smuzhiyun 	ib_dma_unmap_single(dev, dma_addr, sizeof(*hdr), dir);
447*4882a593Smuzhiyun 	kfree(hdr);
448*4882a593Smuzhiyun }
449*4882a593Smuzhiyun 
rds_dma_hdr_alloc(struct ib_device * dev,dma_addr_t * dma_addr,enum dma_data_direction dir)450*4882a593Smuzhiyun static struct rds_header *rds_dma_hdr_alloc(struct ib_device *dev,
451*4882a593Smuzhiyun 		dma_addr_t *dma_addr, enum dma_data_direction dir)
452*4882a593Smuzhiyun {
453*4882a593Smuzhiyun 	struct rds_header *hdr;
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 	hdr = kzalloc_node(sizeof(*hdr), GFP_KERNEL, ibdev_to_node(dev));
456*4882a593Smuzhiyun 	if (!hdr)
457*4882a593Smuzhiyun 		return NULL;
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun 	*dma_addr = ib_dma_map_single(dev, hdr, sizeof(*hdr),
460*4882a593Smuzhiyun 				      DMA_BIDIRECTIONAL);
461*4882a593Smuzhiyun 	if (ib_dma_mapping_error(dev, *dma_addr)) {
462*4882a593Smuzhiyun 		kfree(hdr);
463*4882a593Smuzhiyun 		return NULL;
464*4882a593Smuzhiyun 	}
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 	return hdr;
467*4882a593Smuzhiyun }
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun /* Free the DMA memory used to store struct rds_header.
470*4882a593Smuzhiyun  *
471*4882a593Smuzhiyun  * @dev: the RDS IB device
472*4882a593Smuzhiyun  * @hdrs: pointer to the array storing DMA memory pointers
473*4882a593Smuzhiyun  * @dma_addrs: pointer to the array storing DMA addresses
474*4882a593Smuzhiyun  * @num_hdars: number of headers to free.
475*4882a593Smuzhiyun  */
rds_dma_hdrs_free(struct rds_ib_device * dev,struct rds_header ** hdrs,dma_addr_t * dma_addrs,u32 num_hdrs,enum dma_data_direction dir)476*4882a593Smuzhiyun static void rds_dma_hdrs_free(struct rds_ib_device *dev,
477*4882a593Smuzhiyun 		struct rds_header **hdrs, dma_addr_t *dma_addrs, u32 num_hdrs,
478*4882a593Smuzhiyun 		enum dma_data_direction dir)
479*4882a593Smuzhiyun {
480*4882a593Smuzhiyun 	u32 i;
481*4882a593Smuzhiyun 
482*4882a593Smuzhiyun 	for (i = 0; i < num_hdrs; i++)
483*4882a593Smuzhiyun 		rds_dma_hdr_free(dev->dev, hdrs[i], dma_addrs[i], dir);
484*4882a593Smuzhiyun 	kvfree(hdrs);
485*4882a593Smuzhiyun 	kvfree(dma_addrs);
486*4882a593Smuzhiyun }
487*4882a593Smuzhiyun 
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun /* Allocate DMA coherent memory to be used to store struct rds_header for
490*4882a593Smuzhiyun  * sending/receiving packets.  The pointers to the DMA memory and the
491*4882a593Smuzhiyun  * associated DMA addresses are stored in two arrays.
492*4882a593Smuzhiyun  *
493*4882a593Smuzhiyun  * @dev: the RDS IB device
494*4882a593Smuzhiyun  * @dma_addrs: pointer to the array for storing DMA addresses
495*4882a593Smuzhiyun  * @num_hdrs: number of headers to allocate
496*4882a593Smuzhiyun  *
497*4882a593Smuzhiyun  * It returns the pointer to the array storing the DMA memory pointers.  On
498*4882a593Smuzhiyun  * error, NULL pointer is returned.
499*4882a593Smuzhiyun  */
rds_dma_hdrs_alloc(struct rds_ib_device * dev,dma_addr_t ** dma_addrs,u32 num_hdrs,enum dma_data_direction dir)500*4882a593Smuzhiyun static struct rds_header **rds_dma_hdrs_alloc(struct rds_ib_device *dev,
501*4882a593Smuzhiyun 		dma_addr_t **dma_addrs, u32 num_hdrs,
502*4882a593Smuzhiyun 		enum dma_data_direction dir)
503*4882a593Smuzhiyun {
504*4882a593Smuzhiyun 	struct rds_header **hdrs;
505*4882a593Smuzhiyun 	dma_addr_t *hdr_daddrs;
506*4882a593Smuzhiyun 	u32 i;
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun 	hdrs = kvmalloc_node(sizeof(*hdrs) * num_hdrs, GFP_KERNEL,
509*4882a593Smuzhiyun 			     ibdev_to_node(dev->dev));
510*4882a593Smuzhiyun 	if (!hdrs)
511*4882a593Smuzhiyun 		return NULL;
512*4882a593Smuzhiyun 
513*4882a593Smuzhiyun 	hdr_daddrs = kvmalloc_node(sizeof(*hdr_daddrs) * num_hdrs, GFP_KERNEL,
514*4882a593Smuzhiyun 				   ibdev_to_node(dev->dev));
515*4882a593Smuzhiyun 	if (!hdr_daddrs) {
516*4882a593Smuzhiyun 		kvfree(hdrs);
517*4882a593Smuzhiyun 		return NULL;
518*4882a593Smuzhiyun 	}
519*4882a593Smuzhiyun 
520*4882a593Smuzhiyun 	for (i = 0; i < num_hdrs; i++) {
521*4882a593Smuzhiyun 		hdrs[i] = rds_dma_hdr_alloc(dev->dev, &hdr_daddrs[i], dir);
522*4882a593Smuzhiyun 		if (!hdrs[i]) {
523*4882a593Smuzhiyun 			rds_dma_hdrs_free(dev, hdrs, hdr_daddrs, i, dir);
524*4882a593Smuzhiyun 			return NULL;
525*4882a593Smuzhiyun 		}
526*4882a593Smuzhiyun 	}
527*4882a593Smuzhiyun 
528*4882a593Smuzhiyun 	*dma_addrs = hdr_daddrs;
529*4882a593Smuzhiyun 	return hdrs;
530*4882a593Smuzhiyun }
531*4882a593Smuzhiyun 
532*4882a593Smuzhiyun /*
533*4882a593Smuzhiyun  * This needs to be very careful to not leave IS_ERR pointers around for
534*4882a593Smuzhiyun  * cleanup to trip over.
535*4882a593Smuzhiyun  */
rds_ib_setup_qp(struct rds_connection * conn)536*4882a593Smuzhiyun static int rds_ib_setup_qp(struct rds_connection *conn)
537*4882a593Smuzhiyun {
538*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
539*4882a593Smuzhiyun 	struct ib_device *dev = ic->i_cm_id->device;
540*4882a593Smuzhiyun 	struct ib_qp_init_attr attr;
541*4882a593Smuzhiyun 	struct ib_cq_init_attr cq_attr = {};
542*4882a593Smuzhiyun 	struct rds_ib_device *rds_ibdev;
543*4882a593Smuzhiyun 	unsigned long max_wrs;
544*4882a593Smuzhiyun 	int ret, fr_queue_space;
545*4882a593Smuzhiyun 
546*4882a593Smuzhiyun 	/*
547*4882a593Smuzhiyun 	 * It's normal to see a null device if an incoming connection races
548*4882a593Smuzhiyun 	 * with device removal, so we don't print a warning.
549*4882a593Smuzhiyun 	 */
550*4882a593Smuzhiyun 	rds_ibdev = rds_ib_get_client_data(dev);
551*4882a593Smuzhiyun 	if (!rds_ibdev)
552*4882a593Smuzhiyun 		return -EOPNOTSUPP;
553*4882a593Smuzhiyun 
554*4882a593Smuzhiyun 	/* The fr_queue_space is currently set to 512, to add extra space on
555*4882a593Smuzhiyun 	 * completion queue and send queue. This extra space is used for FRWR
556*4882a593Smuzhiyun 	 * registration and invalidation work requests
557*4882a593Smuzhiyun 	 */
558*4882a593Smuzhiyun 	fr_queue_space = RDS_IB_DEFAULT_FR_WR;
559*4882a593Smuzhiyun 
560*4882a593Smuzhiyun 	/* add the conn now so that connection establishment has the dev */
561*4882a593Smuzhiyun 	rds_ib_add_conn(rds_ibdev, conn);
562*4882a593Smuzhiyun 
563*4882a593Smuzhiyun 	max_wrs = rds_ibdev->max_wrs < rds_ib_sysctl_max_send_wr + 1 ?
564*4882a593Smuzhiyun 		rds_ibdev->max_wrs - 1 : rds_ib_sysctl_max_send_wr;
565*4882a593Smuzhiyun 	if (ic->i_send_ring.w_nr != max_wrs)
566*4882a593Smuzhiyun 		rds_ib_ring_resize(&ic->i_send_ring, max_wrs);
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	max_wrs = rds_ibdev->max_wrs < rds_ib_sysctl_max_recv_wr + 1 ?
569*4882a593Smuzhiyun 		rds_ibdev->max_wrs - 1 : rds_ib_sysctl_max_recv_wr;
570*4882a593Smuzhiyun 	if (ic->i_recv_ring.w_nr != max_wrs)
571*4882a593Smuzhiyun 		rds_ib_ring_resize(&ic->i_recv_ring, max_wrs);
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun 	/* Protection domain and memory range */
574*4882a593Smuzhiyun 	ic->i_pd = rds_ibdev->pd;
575*4882a593Smuzhiyun 
576*4882a593Smuzhiyun 	ic->i_scq_vector = ibdev_get_unused_vector(rds_ibdev);
577*4882a593Smuzhiyun 	cq_attr.cqe = ic->i_send_ring.w_nr + fr_queue_space + 1;
578*4882a593Smuzhiyun 	cq_attr.comp_vector = ic->i_scq_vector;
579*4882a593Smuzhiyun 	ic->i_send_cq = ib_create_cq(dev, rds_ib_cq_comp_handler_send,
580*4882a593Smuzhiyun 				     rds_ib_cq_event_handler, conn,
581*4882a593Smuzhiyun 				     &cq_attr);
582*4882a593Smuzhiyun 	if (IS_ERR(ic->i_send_cq)) {
583*4882a593Smuzhiyun 		ret = PTR_ERR(ic->i_send_cq);
584*4882a593Smuzhiyun 		ic->i_send_cq = NULL;
585*4882a593Smuzhiyun 		ibdev_put_vector(rds_ibdev, ic->i_scq_vector);
586*4882a593Smuzhiyun 		rdsdebug("ib_create_cq send failed: %d\n", ret);
587*4882a593Smuzhiyun 		goto rds_ibdev_out;
588*4882a593Smuzhiyun 	}
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 	ic->i_rcq_vector = ibdev_get_unused_vector(rds_ibdev);
591*4882a593Smuzhiyun 	cq_attr.cqe = ic->i_recv_ring.w_nr;
592*4882a593Smuzhiyun 	cq_attr.comp_vector = ic->i_rcq_vector;
593*4882a593Smuzhiyun 	ic->i_recv_cq = ib_create_cq(dev, rds_ib_cq_comp_handler_recv,
594*4882a593Smuzhiyun 				     rds_ib_cq_event_handler, conn,
595*4882a593Smuzhiyun 				     &cq_attr);
596*4882a593Smuzhiyun 	if (IS_ERR(ic->i_recv_cq)) {
597*4882a593Smuzhiyun 		ret = PTR_ERR(ic->i_recv_cq);
598*4882a593Smuzhiyun 		ic->i_recv_cq = NULL;
599*4882a593Smuzhiyun 		ibdev_put_vector(rds_ibdev, ic->i_rcq_vector);
600*4882a593Smuzhiyun 		rdsdebug("ib_create_cq recv failed: %d\n", ret);
601*4882a593Smuzhiyun 		goto send_cq_out;
602*4882a593Smuzhiyun 	}
603*4882a593Smuzhiyun 
604*4882a593Smuzhiyun 	ret = ib_req_notify_cq(ic->i_send_cq, IB_CQ_NEXT_COMP);
605*4882a593Smuzhiyun 	if (ret) {
606*4882a593Smuzhiyun 		rdsdebug("ib_req_notify_cq send failed: %d\n", ret);
607*4882a593Smuzhiyun 		goto recv_cq_out;
608*4882a593Smuzhiyun 	}
609*4882a593Smuzhiyun 
610*4882a593Smuzhiyun 	ret = ib_req_notify_cq(ic->i_recv_cq, IB_CQ_SOLICITED);
611*4882a593Smuzhiyun 	if (ret) {
612*4882a593Smuzhiyun 		rdsdebug("ib_req_notify_cq recv failed: %d\n", ret);
613*4882a593Smuzhiyun 		goto recv_cq_out;
614*4882a593Smuzhiyun 	}
615*4882a593Smuzhiyun 
616*4882a593Smuzhiyun 	/* XXX negotiate max send/recv with remote? */
617*4882a593Smuzhiyun 	memset(&attr, 0, sizeof(attr));
618*4882a593Smuzhiyun 	attr.event_handler = rds_ib_qp_event_handler;
619*4882a593Smuzhiyun 	attr.qp_context = conn;
620*4882a593Smuzhiyun 	/* + 1 to allow for the single ack message */
621*4882a593Smuzhiyun 	attr.cap.max_send_wr = ic->i_send_ring.w_nr + fr_queue_space + 1;
622*4882a593Smuzhiyun 	attr.cap.max_recv_wr = ic->i_recv_ring.w_nr + 1;
623*4882a593Smuzhiyun 	attr.cap.max_send_sge = rds_ibdev->max_sge;
624*4882a593Smuzhiyun 	attr.cap.max_recv_sge = RDS_IB_RECV_SGE;
625*4882a593Smuzhiyun 	attr.sq_sig_type = IB_SIGNAL_REQ_WR;
626*4882a593Smuzhiyun 	attr.qp_type = IB_QPT_RC;
627*4882a593Smuzhiyun 	attr.send_cq = ic->i_send_cq;
628*4882a593Smuzhiyun 	attr.recv_cq = ic->i_recv_cq;
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun 	/*
631*4882a593Smuzhiyun 	 * XXX this can fail if max_*_wr is too large?  Are we supposed
632*4882a593Smuzhiyun 	 * to back off until we get a value that the hardware can support?
633*4882a593Smuzhiyun 	 */
634*4882a593Smuzhiyun 	ret = rdma_create_qp(ic->i_cm_id, ic->i_pd, &attr);
635*4882a593Smuzhiyun 	if (ret) {
636*4882a593Smuzhiyun 		rdsdebug("rdma_create_qp failed: %d\n", ret);
637*4882a593Smuzhiyun 		goto recv_cq_out;
638*4882a593Smuzhiyun 	}
639*4882a593Smuzhiyun 
640*4882a593Smuzhiyun 	ic->i_send_hdrs = rds_dma_hdrs_alloc(rds_ibdev, &ic->i_send_hdrs_dma,
641*4882a593Smuzhiyun 					     ic->i_send_ring.w_nr,
642*4882a593Smuzhiyun 					     DMA_TO_DEVICE);
643*4882a593Smuzhiyun 	if (!ic->i_send_hdrs) {
644*4882a593Smuzhiyun 		ret = -ENOMEM;
645*4882a593Smuzhiyun 		rdsdebug("DMA send hdrs alloc failed\n");
646*4882a593Smuzhiyun 		goto qp_out;
647*4882a593Smuzhiyun 	}
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 	ic->i_recv_hdrs = rds_dma_hdrs_alloc(rds_ibdev, &ic->i_recv_hdrs_dma,
650*4882a593Smuzhiyun 					     ic->i_recv_ring.w_nr,
651*4882a593Smuzhiyun 					     DMA_FROM_DEVICE);
652*4882a593Smuzhiyun 	if (!ic->i_recv_hdrs) {
653*4882a593Smuzhiyun 		ret = -ENOMEM;
654*4882a593Smuzhiyun 		rdsdebug("DMA recv hdrs alloc failed\n");
655*4882a593Smuzhiyun 		goto send_hdrs_dma_out;
656*4882a593Smuzhiyun 	}
657*4882a593Smuzhiyun 
658*4882a593Smuzhiyun 	ic->i_ack = rds_dma_hdr_alloc(rds_ibdev->dev, &ic->i_ack_dma,
659*4882a593Smuzhiyun 				      DMA_TO_DEVICE);
660*4882a593Smuzhiyun 	if (!ic->i_ack) {
661*4882a593Smuzhiyun 		ret = -ENOMEM;
662*4882a593Smuzhiyun 		rdsdebug("DMA ack header alloc failed\n");
663*4882a593Smuzhiyun 		goto recv_hdrs_dma_out;
664*4882a593Smuzhiyun 	}
665*4882a593Smuzhiyun 
666*4882a593Smuzhiyun 	ic->i_sends = vzalloc_node(array_size(sizeof(struct rds_ib_send_work),
667*4882a593Smuzhiyun 					      ic->i_send_ring.w_nr),
668*4882a593Smuzhiyun 				   ibdev_to_node(dev));
669*4882a593Smuzhiyun 	if (!ic->i_sends) {
670*4882a593Smuzhiyun 		ret = -ENOMEM;
671*4882a593Smuzhiyun 		rdsdebug("send allocation failed\n");
672*4882a593Smuzhiyun 		goto ack_dma_out;
673*4882a593Smuzhiyun 	}
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun 	ic->i_recvs = vzalloc_node(array_size(sizeof(struct rds_ib_recv_work),
676*4882a593Smuzhiyun 					      ic->i_recv_ring.w_nr),
677*4882a593Smuzhiyun 				   ibdev_to_node(dev));
678*4882a593Smuzhiyun 	if (!ic->i_recvs) {
679*4882a593Smuzhiyun 		ret = -ENOMEM;
680*4882a593Smuzhiyun 		rdsdebug("recv allocation failed\n");
681*4882a593Smuzhiyun 		goto sends_out;
682*4882a593Smuzhiyun 	}
683*4882a593Smuzhiyun 
684*4882a593Smuzhiyun 	rds_ib_recv_init_ack(ic);
685*4882a593Smuzhiyun 
686*4882a593Smuzhiyun 	rdsdebug("conn %p pd %p cq %p %p\n", conn, ic->i_pd,
687*4882a593Smuzhiyun 		 ic->i_send_cq, ic->i_recv_cq);
688*4882a593Smuzhiyun 
689*4882a593Smuzhiyun 	goto out;
690*4882a593Smuzhiyun 
691*4882a593Smuzhiyun sends_out:
692*4882a593Smuzhiyun 	vfree(ic->i_sends);
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun ack_dma_out:
695*4882a593Smuzhiyun 	rds_dma_hdr_free(rds_ibdev->dev, ic->i_ack, ic->i_ack_dma,
696*4882a593Smuzhiyun 			 DMA_TO_DEVICE);
697*4882a593Smuzhiyun 	ic->i_ack = NULL;
698*4882a593Smuzhiyun 
699*4882a593Smuzhiyun recv_hdrs_dma_out:
700*4882a593Smuzhiyun 	rds_dma_hdrs_free(rds_ibdev, ic->i_recv_hdrs, ic->i_recv_hdrs_dma,
701*4882a593Smuzhiyun 			  ic->i_recv_ring.w_nr, DMA_FROM_DEVICE);
702*4882a593Smuzhiyun 	ic->i_recv_hdrs = NULL;
703*4882a593Smuzhiyun 	ic->i_recv_hdrs_dma = NULL;
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun send_hdrs_dma_out:
706*4882a593Smuzhiyun 	rds_dma_hdrs_free(rds_ibdev, ic->i_send_hdrs, ic->i_send_hdrs_dma,
707*4882a593Smuzhiyun 			  ic->i_send_ring.w_nr, DMA_TO_DEVICE);
708*4882a593Smuzhiyun 	ic->i_send_hdrs = NULL;
709*4882a593Smuzhiyun 	ic->i_send_hdrs_dma = NULL;
710*4882a593Smuzhiyun 
711*4882a593Smuzhiyun qp_out:
712*4882a593Smuzhiyun 	rdma_destroy_qp(ic->i_cm_id);
713*4882a593Smuzhiyun recv_cq_out:
714*4882a593Smuzhiyun 	ib_destroy_cq(ic->i_recv_cq);
715*4882a593Smuzhiyun 	ic->i_recv_cq = NULL;
716*4882a593Smuzhiyun send_cq_out:
717*4882a593Smuzhiyun 	ib_destroy_cq(ic->i_send_cq);
718*4882a593Smuzhiyun 	ic->i_send_cq = NULL;
719*4882a593Smuzhiyun rds_ibdev_out:
720*4882a593Smuzhiyun 	rds_ib_remove_conn(rds_ibdev, conn);
721*4882a593Smuzhiyun out:
722*4882a593Smuzhiyun 	rds_ib_dev_put(rds_ibdev);
723*4882a593Smuzhiyun 
724*4882a593Smuzhiyun 	return ret;
725*4882a593Smuzhiyun }
726*4882a593Smuzhiyun 
rds_ib_protocol_compatible(struct rdma_cm_event * event,bool isv6)727*4882a593Smuzhiyun static u32 rds_ib_protocol_compatible(struct rdma_cm_event *event, bool isv6)
728*4882a593Smuzhiyun {
729*4882a593Smuzhiyun 	const union rds_ib_conn_priv *dp = event->param.conn.private_data;
730*4882a593Smuzhiyun 	u8 data_len, major, minor;
731*4882a593Smuzhiyun 	u32 version = 0;
732*4882a593Smuzhiyun 	__be16 mask;
733*4882a593Smuzhiyun 	u16 common;
734*4882a593Smuzhiyun 
735*4882a593Smuzhiyun 	/*
736*4882a593Smuzhiyun 	 * rdma_cm private data is odd - when there is any private data in the
737*4882a593Smuzhiyun 	 * request, we will be given a pretty large buffer without telling us the
738*4882a593Smuzhiyun 	 * original size. The only way to tell the difference is by looking at
739*4882a593Smuzhiyun 	 * the contents, which are initialized to zero.
740*4882a593Smuzhiyun 	 * If the protocol version fields aren't set, this is a connection attempt
741*4882a593Smuzhiyun 	 * from an older version. This could be 3.0 or 2.0 - we can't tell.
742*4882a593Smuzhiyun 	 * We really should have changed this for OFED 1.3 :-(
743*4882a593Smuzhiyun 	 */
744*4882a593Smuzhiyun 
745*4882a593Smuzhiyun 	/* Be paranoid. RDS always has privdata */
746*4882a593Smuzhiyun 	if (!event->param.conn.private_data_len) {
747*4882a593Smuzhiyun 		printk(KERN_NOTICE "RDS incoming connection has no private data, "
748*4882a593Smuzhiyun 			"rejecting\n");
749*4882a593Smuzhiyun 		return 0;
750*4882a593Smuzhiyun 	}
751*4882a593Smuzhiyun 
752*4882a593Smuzhiyun 	if (isv6) {
753*4882a593Smuzhiyun 		data_len = sizeof(struct rds6_ib_connect_private);
754*4882a593Smuzhiyun 		major = dp->ricp_v6.dp_protocol_major;
755*4882a593Smuzhiyun 		minor = dp->ricp_v6.dp_protocol_minor;
756*4882a593Smuzhiyun 		mask = dp->ricp_v6.dp_protocol_minor_mask;
757*4882a593Smuzhiyun 	} else {
758*4882a593Smuzhiyun 		data_len = sizeof(struct rds_ib_connect_private);
759*4882a593Smuzhiyun 		major = dp->ricp_v4.dp_protocol_major;
760*4882a593Smuzhiyun 		minor = dp->ricp_v4.dp_protocol_minor;
761*4882a593Smuzhiyun 		mask = dp->ricp_v4.dp_protocol_minor_mask;
762*4882a593Smuzhiyun 	}
763*4882a593Smuzhiyun 
764*4882a593Smuzhiyun 	/* Even if len is crap *now* I still want to check it. -ASG */
765*4882a593Smuzhiyun 	if (event->param.conn.private_data_len < data_len || major == 0)
766*4882a593Smuzhiyun 		return RDS_PROTOCOL_4_0;
767*4882a593Smuzhiyun 
768*4882a593Smuzhiyun 	common = be16_to_cpu(mask) & RDS_IB_SUPPORTED_PROTOCOLS;
769*4882a593Smuzhiyun 	if (major == 4 && common) {
770*4882a593Smuzhiyun 		version = RDS_PROTOCOL_4_0;
771*4882a593Smuzhiyun 		while ((common >>= 1) != 0)
772*4882a593Smuzhiyun 			version++;
773*4882a593Smuzhiyun 	} else if (RDS_PROTOCOL_COMPAT_VERSION ==
774*4882a593Smuzhiyun 		   RDS_PROTOCOL(major, minor)) {
775*4882a593Smuzhiyun 		version = RDS_PROTOCOL_COMPAT_VERSION;
776*4882a593Smuzhiyun 	} else {
777*4882a593Smuzhiyun 		if (isv6)
778*4882a593Smuzhiyun 			printk_ratelimited(KERN_NOTICE "RDS: Connection from %pI6c using incompatible protocol version %u.%u\n",
779*4882a593Smuzhiyun 					   &dp->ricp_v6.dp_saddr, major, minor);
780*4882a593Smuzhiyun 		else
781*4882a593Smuzhiyun 			printk_ratelimited(KERN_NOTICE "RDS: Connection from %pI4 using incompatible protocol version %u.%u\n",
782*4882a593Smuzhiyun 					   &dp->ricp_v4.dp_saddr, major, minor);
783*4882a593Smuzhiyun 	}
784*4882a593Smuzhiyun 	return version;
785*4882a593Smuzhiyun }
786*4882a593Smuzhiyun 
787*4882a593Smuzhiyun #if IS_ENABLED(CONFIG_IPV6)
788*4882a593Smuzhiyun /* Given an IPv6 address, find the net_device which hosts that address and
789*4882a593Smuzhiyun  * return its index.  This is used by the rds_ib_cm_handle_connect() code to
790*4882a593Smuzhiyun  * find the interface index of where an incoming request comes from when
791*4882a593Smuzhiyun  * the request is using a link local address.
792*4882a593Smuzhiyun  *
793*4882a593Smuzhiyun  * Note one problem in this search.  It is possible that two interfaces have
794*4882a593Smuzhiyun  * the same link local address.  Unfortunately, this cannot be solved unless
795*4882a593Smuzhiyun  * the underlying layer gives us the interface which an incoming RDMA connect
796*4882a593Smuzhiyun  * request comes from.
797*4882a593Smuzhiyun  */
__rds_find_ifindex(struct net * net,const struct in6_addr * addr)798*4882a593Smuzhiyun static u32 __rds_find_ifindex(struct net *net, const struct in6_addr *addr)
799*4882a593Smuzhiyun {
800*4882a593Smuzhiyun 	struct net_device *dev;
801*4882a593Smuzhiyun 	int idx = 0;
802*4882a593Smuzhiyun 
803*4882a593Smuzhiyun 	rcu_read_lock();
804*4882a593Smuzhiyun 	for_each_netdev_rcu(net, dev) {
805*4882a593Smuzhiyun 		if (ipv6_chk_addr(net, addr, dev, 1)) {
806*4882a593Smuzhiyun 			idx = dev->ifindex;
807*4882a593Smuzhiyun 			break;
808*4882a593Smuzhiyun 		}
809*4882a593Smuzhiyun 	}
810*4882a593Smuzhiyun 	rcu_read_unlock();
811*4882a593Smuzhiyun 
812*4882a593Smuzhiyun 	return idx;
813*4882a593Smuzhiyun }
814*4882a593Smuzhiyun #endif
815*4882a593Smuzhiyun 
rds_ib_cm_handle_connect(struct rdma_cm_id * cm_id,struct rdma_cm_event * event,bool isv6)816*4882a593Smuzhiyun int rds_ib_cm_handle_connect(struct rdma_cm_id *cm_id,
817*4882a593Smuzhiyun 			     struct rdma_cm_event *event, bool isv6)
818*4882a593Smuzhiyun {
819*4882a593Smuzhiyun 	__be64 lguid = cm_id->route.path_rec->sgid.global.interface_id;
820*4882a593Smuzhiyun 	__be64 fguid = cm_id->route.path_rec->dgid.global.interface_id;
821*4882a593Smuzhiyun 	const struct rds_ib_conn_priv_cmn *dp_cmn;
822*4882a593Smuzhiyun 	struct rds_connection *conn = NULL;
823*4882a593Smuzhiyun 	struct rds_ib_connection *ic = NULL;
824*4882a593Smuzhiyun 	struct rdma_conn_param conn_param;
825*4882a593Smuzhiyun 	const union rds_ib_conn_priv *dp;
826*4882a593Smuzhiyun 	union rds_ib_conn_priv dp_rep;
827*4882a593Smuzhiyun 	struct in6_addr s_mapped_addr;
828*4882a593Smuzhiyun 	struct in6_addr d_mapped_addr;
829*4882a593Smuzhiyun 	const struct in6_addr *saddr6;
830*4882a593Smuzhiyun 	const struct in6_addr *daddr6;
831*4882a593Smuzhiyun 	int destroy = 1;
832*4882a593Smuzhiyun 	u32 ifindex = 0;
833*4882a593Smuzhiyun 	u32 version;
834*4882a593Smuzhiyun 	int err = 1;
835*4882a593Smuzhiyun 
836*4882a593Smuzhiyun 	/* Check whether the remote protocol version matches ours. */
837*4882a593Smuzhiyun 	version = rds_ib_protocol_compatible(event, isv6);
838*4882a593Smuzhiyun 	if (!version) {
839*4882a593Smuzhiyun 		err = RDS_RDMA_REJ_INCOMPAT;
840*4882a593Smuzhiyun 		goto out;
841*4882a593Smuzhiyun 	}
842*4882a593Smuzhiyun 
843*4882a593Smuzhiyun 	dp = event->param.conn.private_data;
844*4882a593Smuzhiyun 	if (isv6) {
845*4882a593Smuzhiyun #if IS_ENABLED(CONFIG_IPV6)
846*4882a593Smuzhiyun 		dp_cmn = &dp->ricp_v6.dp_cmn;
847*4882a593Smuzhiyun 		saddr6 = &dp->ricp_v6.dp_saddr;
848*4882a593Smuzhiyun 		daddr6 = &dp->ricp_v6.dp_daddr;
849*4882a593Smuzhiyun 		/* If either address is link local, need to find the
850*4882a593Smuzhiyun 		 * interface index in order to create a proper RDS
851*4882a593Smuzhiyun 		 * connection.
852*4882a593Smuzhiyun 		 */
853*4882a593Smuzhiyun 		if (ipv6_addr_type(daddr6) & IPV6_ADDR_LINKLOCAL) {
854*4882a593Smuzhiyun 			/* Using init_net for now ..  */
855*4882a593Smuzhiyun 			ifindex = __rds_find_ifindex(&init_net, daddr6);
856*4882a593Smuzhiyun 			/* No index found...  Need to bail out. */
857*4882a593Smuzhiyun 			if (ifindex == 0) {
858*4882a593Smuzhiyun 				err = -EOPNOTSUPP;
859*4882a593Smuzhiyun 				goto out;
860*4882a593Smuzhiyun 			}
861*4882a593Smuzhiyun 		} else if (ipv6_addr_type(saddr6) & IPV6_ADDR_LINKLOCAL) {
862*4882a593Smuzhiyun 			/* Use our address to find the correct index. */
863*4882a593Smuzhiyun 			ifindex = __rds_find_ifindex(&init_net, daddr6);
864*4882a593Smuzhiyun 			/* No index found...  Need to bail out. */
865*4882a593Smuzhiyun 			if (ifindex == 0) {
866*4882a593Smuzhiyun 				err = -EOPNOTSUPP;
867*4882a593Smuzhiyun 				goto out;
868*4882a593Smuzhiyun 			}
869*4882a593Smuzhiyun 		}
870*4882a593Smuzhiyun #else
871*4882a593Smuzhiyun 		err = -EOPNOTSUPP;
872*4882a593Smuzhiyun 		goto out;
873*4882a593Smuzhiyun #endif
874*4882a593Smuzhiyun 	} else {
875*4882a593Smuzhiyun 		dp_cmn = &dp->ricp_v4.dp_cmn;
876*4882a593Smuzhiyun 		ipv6_addr_set_v4mapped(dp->ricp_v4.dp_saddr, &s_mapped_addr);
877*4882a593Smuzhiyun 		ipv6_addr_set_v4mapped(dp->ricp_v4.dp_daddr, &d_mapped_addr);
878*4882a593Smuzhiyun 		saddr6 = &s_mapped_addr;
879*4882a593Smuzhiyun 		daddr6 = &d_mapped_addr;
880*4882a593Smuzhiyun 	}
881*4882a593Smuzhiyun 
882*4882a593Smuzhiyun 	rdsdebug("saddr %pI6c daddr %pI6c RDSv%u.%u lguid 0x%llx fguid 0x%llx, tos:%d\n",
883*4882a593Smuzhiyun 		 saddr6, daddr6, RDS_PROTOCOL_MAJOR(version),
884*4882a593Smuzhiyun 		 RDS_PROTOCOL_MINOR(version),
885*4882a593Smuzhiyun 		 (unsigned long long)be64_to_cpu(lguid),
886*4882a593Smuzhiyun 		 (unsigned long long)be64_to_cpu(fguid), dp_cmn->ricpc_dp_toss);
887*4882a593Smuzhiyun 
888*4882a593Smuzhiyun 	/* RDS/IB is not currently netns aware, thus init_net */
889*4882a593Smuzhiyun 	conn = rds_conn_create(&init_net, daddr6, saddr6,
890*4882a593Smuzhiyun 			       &rds_ib_transport, dp_cmn->ricpc_dp_toss,
891*4882a593Smuzhiyun 			       GFP_KERNEL, ifindex);
892*4882a593Smuzhiyun 	if (IS_ERR(conn)) {
893*4882a593Smuzhiyun 		rdsdebug("rds_conn_create failed (%ld)\n", PTR_ERR(conn));
894*4882a593Smuzhiyun 		conn = NULL;
895*4882a593Smuzhiyun 		goto out;
896*4882a593Smuzhiyun 	}
897*4882a593Smuzhiyun 
898*4882a593Smuzhiyun 	/*
899*4882a593Smuzhiyun 	 * The connection request may occur while the
900*4882a593Smuzhiyun 	 * previous connection exist, e.g. in case of failover.
901*4882a593Smuzhiyun 	 * But as connections may be initiated simultaneously
902*4882a593Smuzhiyun 	 * by both hosts, we have a random backoff mechanism -
903*4882a593Smuzhiyun 	 * see the comment above rds_queue_reconnect()
904*4882a593Smuzhiyun 	 */
905*4882a593Smuzhiyun 	mutex_lock(&conn->c_cm_lock);
906*4882a593Smuzhiyun 	if (!rds_conn_transition(conn, RDS_CONN_DOWN, RDS_CONN_CONNECTING)) {
907*4882a593Smuzhiyun 		if (rds_conn_state(conn) == RDS_CONN_UP) {
908*4882a593Smuzhiyun 			rdsdebug("incoming connect while connecting\n");
909*4882a593Smuzhiyun 			rds_conn_drop(conn);
910*4882a593Smuzhiyun 			rds_ib_stats_inc(s_ib_listen_closed_stale);
911*4882a593Smuzhiyun 		} else
912*4882a593Smuzhiyun 		if (rds_conn_state(conn) == RDS_CONN_CONNECTING) {
913*4882a593Smuzhiyun 			/* Wait and see - our connect may still be succeeding */
914*4882a593Smuzhiyun 			rds_ib_stats_inc(s_ib_connect_raced);
915*4882a593Smuzhiyun 		}
916*4882a593Smuzhiyun 		goto out;
917*4882a593Smuzhiyun 	}
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	ic = conn->c_transport_data;
920*4882a593Smuzhiyun 
921*4882a593Smuzhiyun 	rds_ib_set_protocol(conn, version);
922*4882a593Smuzhiyun 	rds_ib_set_flow_control(conn, be32_to_cpu(dp_cmn->ricpc_credit));
923*4882a593Smuzhiyun 
924*4882a593Smuzhiyun 	/* If the peer gave us the last packet it saw, process this as if
925*4882a593Smuzhiyun 	 * we had received a regular ACK. */
926*4882a593Smuzhiyun 	if (dp_cmn->ricpc_ack_seq)
927*4882a593Smuzhiyun 		rds_send_drop_acked(conn, be64_to_cpu(dp_cmn->ricpc_ack_seq),
928*4882a593Smuzhiyun 				    NULL);
929*4882a593Smuzhiyun 
930*4882a593Smuzhiyun 	BUG_ON(cm_id->context);
931*4882a593Smuzhiyun 	BUG_ON(ic->i_cm_id);
932*4882a593Smuzhiyun 
933*4882a593Smuzhiyun 	ic->i_cm_id = cm_id;
934*4882a593Smuzhiyun 	cm_id->context = conn;
935*4882a593Smuzhiyun 
936*4882a593Smuzhiyun 	/* We got halfway through setting up the ib_connection, if we
937*4882a593Smuzhiyun 	 * fail now, we have to take the long route out of this mess. */
938*4882a593Smuzhiyun 	destroy = 0;
939*4882a593Smuzhiyun 
940*4882a593Smuzhiyun 	err = rds_ib_setup_qp(conn);
941*4882a593Smuzhiyun 	if (err) {
942*4882a593Smuzhiyun 		rds_ib_conn_error(conn, "rds_ib_setup_qp failed (%d)\n", err);
943*4882a593Smuzhiyun 		goto out;
944*4882a593Smuzhiyun 	}
945*4882a593Smuzhiyun 
946*4882a593Smuzhiyun 	rds_ib_cm_fill_conn_param(conn, &conn_param, &dp_rep, version,
947*4882a593Smuzhiyun 				  event->param.conn.responder_resources,
948*4882a593Smuzhiyun 				  event->param.conn.initiator_depth, isv6);
949*4882a593Smuzhiyun 
950*4882a593Smuzhiyun 	/* rdma_accept() calls rdma_reject() internally if it fails */
951*4882a593Smuzhiyun 	if (rdma_accept(cm_id, &conn_param))
952*4882a593Smuzhiyun 		rds_ib_conn_error(conn, "rdma_accept failed\n");
953*4882a593Smuzhiyun 
954*4882a593Smuzhiyun out:
955*4882a593Smuzhiyun 	if (conn)
956*4882a593Smuzhiyun 		mutex_unlock(&conn->c_cm_lock);
957*4882a593Smuzhiyun 	if (err)
958*4882a593Smuzhiyun 		rdma_reject(cm_id, &err, sizeof(int),
959*4882a593Smuzhiyun 			    IB_CM_REJ_CONSUMER_DEFINED);
960*4882a593Smuzhiyun 	return destroy;
961*4882a593Smuzhiyun }
962*4882a593Smuzhiyun 
963*4882a593Smuzhiyun 
rds_ib_cm_initiate_connect(struct rdma_cm_id * cm_id,bool isv6)964*4882a593Smuzhiyun int rds_ib_cm_initiate_connect(struct rdma_cm_id *cm_id, bool isv6)
965*4882a593Smuzhiyun {
966*4882a593Smuzhiyun 	struct rds_connection *conn = cm_id->context;
967*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
968*4882a593Smuzhiyun 	struct rdma_conn_param conn_param;
969*4882a593Smuzhiyun 	union rds_ib_conn_priv dp;
970*4882a593Smuzhiyun 	int ret;
971*4882a593Smuzhiyun 
972*4882a593Smuzhiyun 	/* If the peer doesn't do protocol negotiation, we must
973*4882a593Smuzhiyun 	 * default to RDSv3.0 */
974*4882a593Smuzhiyun 	rds_ib_set_protocol(conn, RDS_PROTOCOL_4_1);
975*4882a593Smuzhiyun 	ic->i_flowctl = rds_ib_sysctl_flow_control;	/* advertise flow control */
976*4882a593Smuzhiyun 
977*4882a593Smuzhiyun 	ret = rds_ib_setup_qp(conn);
978*4882a593Smuzhiyun 	if (ret) {
979*4882a593Smuzhiyun 		rds_ib_conn_error(conn, "rds_ib_setup_qp failed (%d)\n", ret);
980*4882a593Smuzhiyun 		goto out;
981*4882a593Smuzhiyun 	}
982*4882a593Smuzhiyun 
983*4882a593Smuzhiyun 	rds_ib_cm_fill_conn_param(conn, &conn_param, &dp,
984*4882a593Smuzhiyun 				  conn->c_proposed_version,
985*4882a593Smuzhiyun 				  UINT_MAX, UINT_MAX, isv6);
986*4882a593Smuzhiyun 	ret = rdma_connect_locked(cm_id, &conn_param);
987*4882a593Smuzhiyun 	if (ret)
988*4882a593Smuzhiyun 		rds_ib_conn_error(conn, "rdma_connect_locked failed (%d)\n",
989*4882a593Smuzhiyun 				  ret);
990*4882a593Smuzhiyun 
991*4882a593Smuzhiyun out:
992*4882a593Smuzhiyun 	/* Beware - returning non-zero tells the rdma_cm to destroy
993*4882a593Smuzhiyun 	 * the cm_id. We should certainly not do it as long as we still
994*4882a593Smuzhiyun 	 * "own" the cm_id. */
995*4882a593Smuzhiyun 	if (ret) {
996*4882a593Smuzhiyun 		if (ic->i_cm_id == cm_id)
997*4882a593Smuzhiyun 			ret = 0;
998*4882a593Smuzhiyun 	}
999*4882a593Smuzhiyun 	ic->i_active_side = true;
1000*4882a593Smuzhiyun 	return ret;
1001*4882a593Smuzhiyun }
1002*4882a593Smuzhiyun 
rds_ib_conn_path_connect(struct rds_conn_path * cp)1003*4882a593Smuzhiyun int rds_ib_conn_path_connect(struct rds_conn_path *cp)
1004*4882a593Smuzhiyun {
1005*4882a593Smuzhiyun 	struct rds_connection *conn = cp->cp_conn;
1006*4882a593Smuzhiyun 	struct sockaddr_storage src, dest;
1007*4882a593Smuzhiyun 	rdma_cm_event_handler handler;
1008*4882a593Smuzhiyun 	struct rds_ib_connection *ic;
1009*4882a593Smuzhiyun 	int ret;
1010*4882a593Smuzhiyun 
1011*4882a593Smuzhiyun 	ic = conn->c_transport_data;
1012*4882a593Smuzhiyun 
1013*4882a593Smuzhiyun 	/* XXX I wonder what affect the port space has */
1014*4882a593Smuzhiyun 	/* delegate cm event handler to rdma_transport */
1015*4882a593Smuzhiyun #if IS_ENABLED(CONFIG_IPV6)
1016*4882a593Smuzhiyun 	if (conn->c_isv6)
1017*4882a593Smuzhiyun 		handler = rds6_rdma_cm_event_handler;
1018*4882a593Smuzhiyun 	else
1019*4882a593Smuzhiyun #endif
1020*4882a593Smuzhiyun 		handler = rds_rdma_cm_event_handler;
1021*4882a593Smuzhiyun 	ic->i_cm_id = rdma_create_id(&init_net, handler, conn,
1022*4882a593Smuzhiyun 				     RDMA_PS_TCP, IB_QPT_RC);
1023*4882a593Smuzhiyun 	if (IS_ERR(ic->i_cm_id)) {
1024*4882a593Smuzhiyun 		ret = PTR_ERR(ic->i_cm_id);
1025*4882a593Smuzhiyun 		ic->i_cm_id = NULL;
1026*4882a593Smuzhiyun 		rdsdebug("rdma_create_id() failed: %d\n", ret);
1027*4882a593Smuzhiyun 		goto out;
1028*4882a593Smuzhiyun 	}
1029*4882a593Smuzhiyun 
1030*4882a593Smuzhiyun 	rdsdebug("created cm id %p for conn %p\n", ic->i_cm_id, conn);
1031*4882a593Smuzhiyun 
1032*4882a593Smuzhiyun 	if (ipv6_addr_v4mapped(&conn->c_faddr)) {
1033*4882a593Smuzhiyun 		struct sockaddr_in *sin;
1034*4882a593Smuzhiyun 
1035*4882a593Smuzhiyun 		sin = (struct sockaddr_in *)&src;
1036*4882a593Smuzhiyun 		sin->sin_family = AF_INET;
1037*4882a593Smuzhiyun 		sin->sin_addr.s_addr = conn->c_laddr.s6_addr32[3];
1038*4882a593Smuzhiyun 		sin->sin_port = 0;
1039*4882a593Smuzhiyun 
1040*4882a593Smuzhiyun 		sin = (struct sockaddr_in *)&dest;
1041*4882a593Smuzhiyun 		sin->sin_family = AF_INET;
1042*4882a593Smuzhiyun 		sin->sin_addr.s_addr = conn->c_faddr.s6_addr32[3];
1043*4882a593Smuzhiyun 		sin->sin_port = htons(RDS_PORT);
1044*4882a593Smuzhiyun 	} else {
1045*4882a593Smuzhiyun 		struct sockaddr_in6 *sin6;
1046*4882a593Smuzhiyun 
1047*4882a593Smuzhiyun 		sin6 = (struct sockaddr_in6 *)&src;
1048*4882a593Smuzhiyun 		sin6->sin6_family = AF_INET6;
1049*4882a593Smuzhiyun 		sin6->sin6_addr = conn->c_laddr;
1050*4882a593Smuzhiyun 		sin6->sin6_port = 0;
1051*4882a593Smuzhiyun 		sin6->sin6_scope_id = conn->c_dev_if;
1052*4882a593Smuzhiyun 
1053*4882a593Smuzhiyun 		sin6 = (struct sockaddr_in6 *)&dest;
1054*4882a593Smuzhiyun 		sin6->sin6_family = AF_INET6;
1055*4882a593Smuzhiyun 		sin6->sin6_addr = conn->c_faddr;
1056*4882a593Smuzhiyun 		sin6->sin6_port = htons(RDS_CM_PORT);
1057*4882a593Smuzhiyun 		sin6->sin6_scope_id = conn->c_dev_if;
1058*4882a593Smuzhiyun 	}
1059*4882a593Smuzhiyun 
1060*4882a593Smuzhiyun 	ret = rdma_resolve_addr(ic->i_cm_id, (struct sockaddr *)&src,
1061*4882a593Smuzhiyun 				(struct sockaddr *)&dest,
1062*4882a593Smuzhiyun 				RDS_RDMA_RESOLVE_TIMEOUT_MS);
1063*4882a593Smuzhiyun 	if (ret) {
1064*4882a593Smuzhiyun 		rdsdebug("addr resolve failed for cm id %p: %d\n", ic->i_cm_id,
1065*4882a593Smuzhiyun 			 ret);
1066*4882a593Smuzhiyun 		rdma_destroy_id(ic->i_cm_id);
1067*4882a593Smuzhiyun 		ic->i_cm_id = NULL;
1068*4882a593Smuzhiyun 	}
1069*4882a593Smuzhiyun 
1070*4882a593Smuzhiyun out:
1071*4882a593Smuzhiyun 	return ret;
1072*4882a593Smuzhiyun }
1073*4882a593Smuzhiyun 
1074*4882a593Smuzhiyun /*
1075*4882a593Smuzhiyun  * This is so careful about only cleaning up resources that were built up
1076*4882a593Smuzhiyun  * so that it can be called at any point during startup.  In fact it
1077*4882a593Smuzhiyun  * can be called multiple times for a given connection.
1078*4882a593Smuzhiyun  */
rds_ib_conn_path_shutdown(struct rds_conn_path * cp)1079*4882a593Smuzhiyun void rds_ib_conn_path_shutdown(struct rds_conn_path *cp)
1080*4882a593Smuzhiyun {
1081*4882a593Smuzhiyun 	struct rds_connection *conn = cp->cp_conn;
1082*4882a593Smuzhiyun 	struct rds_ib_connection *ic = conn->c_transport_data;
1083*4882a593Smuzhiyun 	int err = 0;
1084*4882a593Smuzhiyun 
1085*4882a593Smuzhiyun 	rdsdebug("cm %p pd %p cq %p %p qp %p\n", ic->i_cm_id,
1086*4882a593Smuzhiyun 		 ic->i_pd, ic->i_send_cq, ic->i_recv_cq,
1087*4882a593Smuzhiyun 		 ic->i_cm_id ? ic->i_cm_id->qp : NULL);
1088*4882a593Smuzhiyun 
1089*4882a593Smuzhiyun 	if (ic->i_cm_id) {
1090*4882a593Smuzhiyun 		rdsdebug("disconnecting cm %p\n", ic->i_cm_id);
1091*4882a593Smuzhiyun 		err = rdma_disconnect(ic->i_cm_id);
1092*4882a593Smuzhiyun 		if (err) {
1093*4882a593Smuzhiyun 			/* Actually this may happen quite frequently, when
1094*4882a593Smuzhiyun 			 * an outgoing connect raced with an incoming connect.
1095*4882a593Smuzhiyun 			 */
1096*4882a593Smuzhiyun 			rdsdebug("failed to disconnect, cm: %p err %d\n",
1097*4882a593Smuzhiyun 				ic->i_cm_id, err);
1098*4882a593Smuzhiyun 		}
1099*4882a593Smuzhiyun 
1100*4882a593Smuzhiyun 		/* kick off "flush_worker" for all pools in order to reap
1101*4882a593Smuzhiyun 		 * all FRMR registrations that are still marked "FRMR_IS_INUSE"
1102*4882a593Smuzhiyun 		 */
1103*4882a593Smuzhiyun 		rds_ib_flush_mrs();
1104*4882a593Smuzhiyun 
1105*4882a593Smuzhiyun 		/*
1106*4882a593Smuzhiyun 		 * We want to wait for tx and rx completion to finish
1107*4882a593Smuzhiyun 		 * before we tear down the connection, but we have to be
1108*4882a593Smuzhiyun 		 * careful not to get stuck waiting on a send ring that
1109*4882a593Smuzhiyun 		 * only has unsignaled sends in it.  We've shutdown new
1110*4882a593Smuzhiyun 		 * sends before getting here so by waiting for signaled
1111*4882a593Smuzhiyun 		 * sends to complete we're ensured that there will be no
1112*4882a593Smuzhiyun 		 * more tx processing.
1113*4882a593Smuzhiyun 		 */
1114*4882a593Smuzhiyun 		wait_event(rds_ib_ring_empty_wait,
1115*4882a593Smuzhiyun 			   rds_ib_ring_empty(&ic->i_recv_ring) &&
1116*4882a593Smuzhiyun 			   (atomic_read(&ic->i_signaled_sends) == 0) &&
1117*4882a593Smuzhiyun 			   (atomic_read(&ic->i_fastreg_inuse_count) == 0) &&
1118*4882a593Smuzhiyun 			   (atomic_read(&ic->i_fastreg_wrs) == RDS_IB_DEFAULT_FR_WR));
1119*4882a593Smuzhiyun 		tasklet_kill(&ic->i_send_tasklet);
1120*4882a593Smuzhiyun 		tasklet_kill(&ic->i_recv_tasklet);
1121*4882a593Smuzhiyun 
1122*4882a593Smuzhiyun 		atomic_set(&ic->i_cq_quiesce, 1);
1123*4882a593Smuzhiyun 
1124*4882a593Smuzhiyun 		/* first destroy the ib state that generates callbacks */
1125*4882a593Smuzhiyun 		if (ic->i_cm_id->qp)
1126*4882a593Smuzhiyun 			rdma_destroy_qp(ic->i_cm_id);
1127*4882a593Smuzhiyun 		if (ic->i_send_cq) {
1128*4882a593Smuzhiyun 			if (ic->rds_ibdev)
1129*4882a593Smuzhiyun 				ibdev_put_vector(ic->rds_ibdev, ic->i_scq_vector);
1130*4882a593Smuzhiyun 			ib_destroy_cq(ic->i_send_cq);
1131*4882a593Smuzhiyun 		}
1132*4882a593Smuzhiyun 
1133*4882a593Smuzhiyun 		if (ic->i_recv_cq) {
1134*4882a593Smuzhiyun 			if (ic->rds_ibdev)
1135*4882a593Smuzhiyun 				ibdev_put_vector(ic->rds_ibdev, ic->i_rcq_vector);
1136*4882a593Smuzhiyun 			ib_destroy_cq(ic->i_recv_cq);
1137*4882a593Smuzhiyun 		}
1138*4882a593Smuzhiyun 
1139*4882a593Smuzhiyun 		if (ic->rds_ibdev) {
1140*4882a593Smuzhiyun 			/* then free the resources that ib callbacks use */
1141*4882a593Smuzhiyun 			if (ic->i_send_hdrs) {
1142*4882a593Smuzhiyun 				rds_dma_hdrs_free(ic->rds_ibdev,
1143*4882a593Smuzhiyun 						  ic->i_send_hdrs,
1144*4882a593Smuzhiyun 						  ic->i_send_hdrs_dma,
1145*4882a593Smuzhiyun 						  ic->i_send_ring.w_nr,
1146*4882a593Smuzhiyun 						  DMA_TO_DEVICE);
1147*4882a593Smuzhiyun 				ic->i_send_hdrs = NULL;
1148*4882a593Smuzhiyun 				ic->i_send_hdrs_dma = NULL;
1149*4882a593Smuzhiyun 			}
1150*4882a593Smuzhiyun 
1151*4882a593Smuzhiyun 			if (ic->i_recv_hdrs) {
1152*4882a593Smuzhiyun 				rds_dma_hdrs_free(ic->rds_ibdev,
1153*4882a593Smuzhiyun 						  ic->i_recv_hdrs,
1154*4882a593Smuzhiyun 						  ic->i_recv_hdrs_dma,
1155*4882a593Smuzhiyun 						  ic->i_recv_ring.w_nr,
1156*4882a593Smuzhiyun 						  DMA_FROM_DEVICE);
1157*4882a593Smuzhiyun 				ic->i_recv_hdrs = NULL;
1158*4882a593Smuzhiyun 				ic->i_recv_hdrs_dma = NULL;
1159*4882a593Smuzhiyun 			}
1160*4882a593Smuzhiyun 
1161*4882a593Smuzhiyun 			if (ic->i_ack) {
1162*4882a593Smuzhiyun 				rds_dma_hdr_free(ic->rds_ibdev->dev, ic->i_ack,
1163*4882a593Smuzhiyun 						 ic->i_ack_dma, DMA_TO_DEVICE);
1164*4882a593Smuzhiyun 				ic->i_ack = NULL;
1165*4882a593Smuzhiyun 			}
1166*4882a593Smuzhiyun 		} else {
1167*4882a593Smuzhiyun 			WARN_ON(ic->i_send_hdrs);
1168*4882a593Smuzhiyun 			WARN_ON(ic->i_send_hdrs_dma);
1169*4882a593Smuzhiyun 			WARN_ON(ic->i_recv_hdrs);
1170*4882a593Smuzhiyun 			WARN_ON(ic->i_recv_hdrs_dma);
1171*4882a593Smuzhiyun 			WARN_ON(ic->i_ack);
1172*4882a593Smuzhiyun 		}
1173*4882a593Smuzhiyun 
1174*4882a593Smuzhiyun 		if (ic->i_sends)
1175*4882a593Smuzhiyun 			rds_ib_send_clear_ring(ic);
1176*4882a593Smuzhiyun 		if (ic->i_recvs)
1177*4882a593Smuzhiyun 			rds_ib_recv_clear_ring(ic);
1178*4882a593Smuzhiyun 
1179*4882a593Smuzhiyun 		rdma_destroy_id(ic->i_cm_id);
1180*4882a593Smuzhiyun 
1181*4882a593Smuzhiyun 		/*
1182*4882a593Smuzhiyun 		 * Move connection back to the nodev list.
1183*4882a593Smuzhiyun 		 */
1184*4882a593Smuzhiyun 		if (ic->rds_ibdev)
1185*4882a593Smuzhiyun 			rds_ib_remove_conn(ic->rds_ibdev, conn);
1186*4882a593Smuzhiyun 
1187*4882a593Smuzhiyun 		ic->i_cm_id = NULL;
1188*4882a593Smuzhiyun 		ic->i_pd = NULL;
1189*4882a593Smuzhiyun 		ic->i_send_cq = NULL;
1190*4882a593Smuzhiyun 		ic->i_recv_cq = NULL;
1191*4882a593Smuzhiyun 	}
1192*4882a593Smuzhiyun 	BUG_ON(ic->rds_ibdev);
1193*4882a593Smuzhiyun 
1194*4882a593Smuzhiyun 	/* Clear pending transmit */
1195*4882a593Smuzhiyun 	if (ic->i_data_op) {
1196*4882a593Smuzhiyun 		struct rds_message *rm;
1197*4882a593Smuzhiyun 
1198*4882a593Smuzhiyun 		rm = container_of(ic->i_data_op, struct rds_message, data);
1199*4882a593Smuzhiyun 		rds_message_put(rm);
1200*4882a593Smuzhiyun 		ic->i_data_op = NULL;
1201*4882a593Smuzhiyun 	}
1202*4882a593Smuzhiyun 
1203*4882a593Smuzhiyun 	/* Clear the ACK state */
1204*4882a593Smuzhiyun 	clear_bit(IB_ACK_IN_FLIGHT, &ic->i_ack_flags);
1205*4882a593Smuzhiyun #ifdef KERNEL_HAS_ATOMIC64
1206*4882a593Smuzhiyun 	atomic64_set(&ic->i_ack_next, 0);
1207*4882a593Smuzhiyun #else
1208*4882a593Smuzhiyun 	ic->i_ack_next = 0;
1209*4882a593Smuzhiyun #endif
1210*4882a593Smuzhiyun 	ic->i_ack_recv = 0;
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun 	/* Clear flow control state */
1213*4882a593Smuzhiyun 	ic->i_flowctl = 0;
1214*4882a593Smuzhiyun 	atomic_set(&ic->i_credits, 0);
1215*4882a593Smuzhiyun 
1216*4882a593Smuzhiyun 	/* Re-init rings, but retain sizes. */
1217*4882a593Smuzhiyun 	rds_ib_ring_init(&ic->i_send_ring, ic->i_send_ring.w_nr);
1218*4882a593Smuzhiyun 	rds_ib_ring_init(&ic->i_recv_ring, ic->i_recv_ring.w_nr);
1219*4882a593Smuzhiyun 
1220*4882a593Smuzhiyun 	if (ic->i_ibinc) {
1221*4882a593Smuzhiyun 		rds_inc_put(&ic->i_ibinc->ii_inc);
1222*4882a593Smuzhiyun 		ic->i_ibinc = NULL;
1223*4882a593Smuzhiyun 	}
1224*4882a593Smuzhiyun 
1225*4882a593Smuzhiyun 	vfree(ic->i_sends);
1226*4882a593Smuzhiyun 	ic->i_sends = NULL;
1227*4882a593Smuzhiyun 	vfree(ic->i_recvs);
1228*4882a593Smuzhiyun 	ic->i_recvs = NULL;
1229*4882a593Smuzhiyun 	ic->i_active_side = false;
1230*4882a593Smuzhiyun }
1231*4882a593Smuzhiyun 
rds_ib_conn_alloc(struct rds_connection * conn,gfp_t gfp)1232*4882a593Smuzhiyun int rds_ib_conn_alloc(struct rds_connection *conn, gfp_t gfp)
1233*4882a593Smuzhiyun {
1234*4882a593Smuzhiyun 	struct rds_ib_connection *ic;
1235*4882a593Smuzhiyun 	unsigned long flags;
1236*4882a593Smuzhiyun 	int ret;
1237*4882a593Smuzhiyun 
1238*4882a593Smuzhiyun 	/* XXX too lazy? */
1239*4882a593Smuzhiyun 	ic = kzalloc(sizeof(struct rds_ib_connection), gfp);
1240*4882a593Smuzhiyun 	if (!ic)
1241*4882a593Smuzhiyun 		return -ENOMEM;
1242*4882a593Smuzhiyun 
1243*4882a593Smuzhiyun 	ret = rds_ib_recv_alloc_caches(ic, gfp);
1244*4882a593Smuzhiyun 	if (ret) {
1245*4882a593Smuzhiyun 		kfree(ic);
1246*4882a593Smuzhiyun 		return ret;
1247*4882a593Smuzhiyun 	}
1248*4882a593Smuzhiyun 
1249*4882a593Smuzhiyun 	INIT_LIST_HEAD(&ic->ib_node);
1250*4882a593Smuzhiyun 	tasklet_init(&ic->i_send_tasklet, rds_ib_tasklet_fn_send,
1251*4882a593Smuzhiyun 		     (unsigned long)ic);
1252*4882a593Smuzhiyun 	tasklet_init(&ic->i_recv_tasklet, rds_ib_tasklet_fn_recv,
1253*4882a593Smuzhiyun 		     (unsigned long)ic);
1254*4882a593Smuzhiyun 	mutex_init(&ic->i_recv_mutex);
1255*4882a593Smuzhiyun #ifndef KERNEL_HAS_ATOMIC64
1256*4882a593Smuzhiyun 	spin_lock_init(&ic->i_ack_lock);
1257*4882a593Smuzhiyun #endif
1258*4882a593Smuzhiyun 	atomic_set(&ic->i_signaled_sends, 0);
1259*4882a593Smuzhiyun 	atomic_set(&ic->i_fastreg_wrs, RDS_IB_DEFAULT_FR_WR);
1260*4882a593Smuzhiyun 
1261*4882a593Smuzhiyun 	/*
1262*4882a593Smuzhiyun 	 * rds_ib_conn_shutdown() waits for these to be emptied so they
1263*4882a593Smuzhiyun 	 * must be initialized before it can be called.
1264*4882a593Smuzhiyun 	 */
1265*4882a593Smuzhiyun 	rds_ib_ring_init(&ic->i_send_ring, 0);
1266*4882a593Smuzhiyun 	rds_ib_ring_init(&ic->i_recv_ring, 0);
1267*4882a593Smuzhiyun 
1268*4882a593Smuzhiyun 	ic->conn = conn;
1269*4882a593Smuzhiyun 	conn->c_transport_data = ic;
1270*4882a593Smuzhiyun 
1271*4882a593Smuzhiyun 	spin_lock_irqsave(&ib_nodev_conns_lock, flags);
1272*4882a593Smuzhiyun 	list_add_tail(&ic->ib_node, &ib_nodev_conns);
1273*4882a593Smuzhiyun 	spin_unlock_irqrestore(&ib_nodev_conns_lock, flags);
1274*4882a593Smuzhiyun 
1275*4882a593Smuzhiyun 
1276*4882a593Smuzhiyun 	rdsdebug("conn %p conn ic %p\n", conn, conn->c_transport_data);
1277*4882a593Smuzhiyun 	return 0;
1278*4882a593Smuzhiyun }
1279*4882a593Smuzhiyun 
1280*4882a593Smuzhiyun /*
1281*4882a593Smuzhiyun  * Free a connection. Connection must be shut down and not set for reconnect.
1282*4882a593Smuzhiyun  */
rds_ib_conn_free(void * arg)1283*4882a593Smuzhiyun void rds_ib_conn_free(void *arg)
1284*4882a593Smuzhiyun {
1285*4882a593Smuzhiyun 	struct rds_ib_connection *ic = arg;
1286*4882a593Smuzhiyun 	spinlock_t	*lock_ptr;
1287*4882a593Smuzhiyun 
1288*4882a593Smuzhiyun 	rdsdebug("ic %p\n", ic);
1289*4882a593Smuzhiyun 
1290*4882a593Smuzhiyun 	/*
1291*4882a593Smuzhiyun 	 * Conn is either on a dev's list or on the nodev list.
1292*4882a593Smuzhiyun 	 * A race with shutdown() or connect() would cause problems
1293*4882a593Smuzhiyun 	 * (since rds_ibdev would change) but that should never happen.
1294*4882a593Smuzhiyun 	 */
1295*4882a593Smuzhiyun 	lock_ptr = ic->rds_ibdev ? &ic->rds_ibdev->spinlock : &ib_nodev_conns_lock;
1296*4882a593Smuzhiyun 
1297*4882a593Smuzhiyun 	spin_lock_irq(lock_ptr);
1298*4882a593Smuzhiyun 	list_del(&ic->ib_node);
1299*4882a593Smuzhiyun 	spin_unlock_irq(lock_ptr);
1300*4882a593Smuzhiyun 
1301*4882a593Smuzhiyun 	rds_ib_recv_free_caches(ic);
1302*4882a593Smuzhiyun 
1303*4882a593Smuzhiyun 	kfree(ic);
1304*4882a593Smuzhiyun }
1305*4882a593Smuzhiyun 
1306*4882a593Smuzhiyun 
1307*4882a593Smuzhiyun /*
1308*4882a593Smuzhiyun  * An error occurred on the connection
1309*4882a593Smuzhiyun  */
1310*4882a593Smuzhiyun void
__rds_ib_conn_error(struct rds_connection * conn,const char * fmt,...)1311*4882a593Smuzhiyun __rds_ib_conn_error(struct rds_connection *conn, const char *fmt, ...)
1312*4882a593Smuzhiyun {
1313*4882a593Smuzhiyun 	va_list ap;
1314*4882a593Smuzhiyun 
1315*4882a593Smuzhiyun 	rds_conn_drop(conn);
1316*4882a593Smuzhiyun 
1317*4882a593Smuzhiyun 	va_start(ap, fmt);
1318*4882a593Smuzhiyun 	vprintk(fmt, ap);
1319*4882a593Smuzhiyun 	va_end(ap);
1320*4882a593Smuzhiyun }
1321