This source file includes following definitions.
- rds_ib_set_protocol
- rds_ib_set_flow_control
- rds_ib_tune_rnr
- rds_ib_cm_connect_complete
- rds_ib_cm_fill_conn_param
- rds_ib_cq_event_handler
- rds_ib_cq_comp_handler_recv
- poll_scq
- rds_ib_tasklet_fn_send
- poll_rcq
- rds_ib_tasklet_fn_recv
- rds_ib_qp_event_handler
- rds_ib_cq_comp_handler_send
- ibdev_get_unused_vector
- ibdev_put_vector
- rds_ib_setup_qp
- rds_ib_protocol_compatible
- __rds_find_ifindex
- rds_ib_cm_handle_connect
- rds_ib_cm_initiate_connect
- rds_ib_conn_path_connect
- rds_ib_conn_path_shutdown
- rds_ib_conn_alloc
- rds_ib_conn_free
- __rds_ib_conn_error
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33 #include <linux/kernel.h>
34 #include <linux/in.h>
35 #include <linux/slab.h>
36 #include <linux/vmalloc.h>
37 #include <linux/ratelimit.h>
38 #include <net/addrconf.h>
39
40 #include "rds_single_path.h"
41 #include "rds.h"
42 #include "ib.h"
43 #include "ib_mr.h"
44
45
46
47
48 static void rds_ib_set_protocol(struct rds_connection *conn, unsigned int version)
49 {
50 conn->c_version = version;
51 }
52
53
54
55
56 static void rds_ib_set_flow_control(struct rds_connection *conn, u32 credits)
57 {
58 struct rds_ib_connection *ic = conn->c_transport_data;
59
60 if (rds_ib_sysctl_flow_control && credits != 0) {
61
62 ic->i_flowctl = 1;
63 rds_ib_send_add_credits(conn, credits);
64 } else {
65 ic->i_flowctl = 0;
66 }
67 }
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83 static void
84 rds_ib_tune_rnr(struct rds_ib_connection *ic, struct ib_qp_attr *attr)
85 {
86 int ret;
87
88 attr->min_rnr_timer = IB_RNR_TIMER_000_32;
89 ret = ib_modify_qp(ic->i_cm_id->qp, attr, IB_QP_MIN_RNR_TIMER);
90 if (ret)
91 printk(KERN_NOTICE "ib_modify_qp(IB_QP_MIN_RNR_TIMER): err=%d\n", -ret);
92 }
93
94
95
96
97
98 void rds_ib_cm_connect_complete(struct rds_connection *conn, struct rdma_cm_event *event)
99 {
100 struct rds_ib_connection *ic = conn->c_transport_data;
101 const union rds_ib_conn_priv *dp = NULL;
102 struct ib_qp_attr qp_attr;
103 __be64 ack_seq = 0;
104 __be32 credit = 0;
105 u8 major = 0;
106 u8 minor = 0;
107 int err;
108
109 dp = event->param.conn.private_data;
110 if (conn->c_isv6) {
111 if (event->param.conn.private_data_len >=
112 sizeof(struct rds6_ib_connect_private)) {
113 major = dp->ricp_v6.dp_protocol_major;
114 minor = dp->ricp_v6.dp_protocol_minor;
115 credit = dp->ricp_v6.dp_credit;
116
117
118
119
120
121 ack_seq = get_unaligned(&dp->ricp_v6.dp_ack_seq);
122 }
123 } else if (event->param.conn.private_data_len >=
124 sizeof(struct rds_ib_connect_private)) {
125 major = dp->ricp_v4.dp_protocol_major;
126 minor = dp->ricp_v4.dp_protocol_minor;
127 credit = dp->ricp_v4.dp_credit;
128 ack_seq = get_unaligned(&dp->ricp_v4.dp_ack_seq);
129 }
130
131
132 if (major) {
133 rds_ib_set_protocol(conn, RDS_PROTOCOL(major, minor));
134 rds_ib_set_flow_control(conn, be32_to_cpu(credit));
135 }
136
137 if (conn->c_version < RDS_PROTOCOL_VERSION) {
138 if (conn->c_version != RDS_PROTOCOL_COMPAT_VERSION) {
139 pr_notice("RDS/IB: Connection <%pI6c,%pI6c> version %u.%u no longer supported\n",
140 &conn->c_laddr, &conn->c_faddr,
141 RDS_PROTOCOL_MAJOR(conn->c_version),
142 RDS_PROTOCOL_MINOR(conn->c_version));
143 rds_conn_destroy(conn);
144 return;
145 }
146 }
147
148 pr_notice("RDS/IB: %s conn connected <%pI6c,%pI6c,%d> version %u.%u%s\n",
149 ic->i_active_side ? "Active" : "Passive",
150 &conn->c_laddr, &conn->c_faddr, conn->c_tos,
151 RDS_PROTOCOL_MAJOR(conn->c_version),
152 RDS_PROTOCOL_MINOR(conn->c_version),
153 ic->i_flowctl ? ", flow control" : "");
154
155
156 ic->i_sl = ic->i_cm_id->route.path_rec->sl;
157
158 atomic_set(&ic->i_cq_quiesce, 0);
159
160
161
162
163
164 rds_ib_send_init_ring(ic);
165 rds_ib_recv_init_ring(ic);
166
167
168 rds_ib_recv_refill(conn, 1, GFP_KERNEL);
169
170
171 rds_ib_tune_rnr(ic, &qp_attr);
172
173 qp_attr.qp_state = IB_QPS_RTS;
174 err = ib_modify_qp(ic->i_cm_id->qp, &qp_attr, IB_QP_STATE);
175 if (err)
176 printk(KERN_NOTICE "ib_modify_qp(IB_QP_STATE, RTS): err=%d\n", err);
177
178
179 err = rds_ib_update_ipaddr(ic->rds_ibdev, &conn->c_laddr);
180 if (err)
181 printk(KERN_ERR "rds_ib_update_ipaddr failed (%d)\n",
182 err);
183
184
185
186 if (dp) {
187 if (ack_seq)
188 rds_send_drop_acked(conn, be64_to_cpu(ack_seq),
189 NULL);
190 }
191
192 conn->c_proposed_version = conn->c_version;
193 rds_connect_complete(conn);
194 }
195
196 static void rds_ib_cm_fill_conn_param(struct rds_connection *conn,
197 struct rdma_conn_param *conn_param,
198 union rds_ib_conn_priv *dp,
199 u32 protocol_version,
200 u32 max_responder_resources,
201 u32 max_initiator_depth,
202 bool isv6)
203 {
204 struct rds_ib_connection *ic = conn->c_transport_data;
205 struct rds_ib_device *rds_ibdev = ic->rds_ibdev;
206
207 memset(conn_param, 0, sizeof(struct rdma_conn_param));
208
209 conn_param->responder_resources =
210 min_t(u32, rds_ibdev->max_responder_resources, max_responder_resources);
211 conn_param->initiator_depth =
212 min_t(u32, rds_ibdev->max_initiator_depth, max_initiator_depth);
213 conn_param->retry_count = min_t(unsigned int, rds_ib_retry_count, 7);
214 conn_param->rnr_retry_count = 7;
215
216 if (dp) {
217 memset(dp, 0, sizeof(*dp));
218 if (isv6) {
219 dp->ricp_v6.dp_saddr = conn->c_laddr;
220 dp->ricp_v6.dp_daddr = conn->c_faddr;
221 dp->ricp_v6.dp_protocol_major =
222 RDS_PROTOCOL_MAJOR(protocol_version);
223 dp->ricp_v6.dp_protocol_minor =
224 RDS_PROTOCOL_MINOR(protocol_version);
225 dp->ricp_v6.dp_protocol_minor_mask =
226 cpu_to_be16(RDS_IB_SUPPORTED_PROTOCOLS);
227 dp->ricp_v6.dp_ack_seq =
228 cpu_to_be64(rds_ib_piggyb_ack(ic));
229 dp->ricp_v6.dp_cmn.ricpc_dp_toss = conn->c_tos;
230
231 conn_param->private_data = &dp->ricp_v6;
232 conn_param->private_data_len = sizeof(dp->ricp_v6);
233 } else {
234 dp->ricp_v4.dp_saddr = conn->c_laddr.s6_addr32[3];
235 dp->ricp_v4.dp_daddr = conn->c_faddr.s6_addr32[3];
236 dp->ricp_v4.dp_protocol_major =
237 RDS_PROTOCOL_MAJOR(protocol_version);
238 dp->ricp_v4.dp_protocol_minor =
239 RDS_PROTOCOL_MINOR(protocol_version);
240 dp->ricp_v4.dp_protocol_minor_mask =
241 cpu_to_be16(RDS_IB_SUPPORTED_PROTOCOLS);
242 dp->ricp_v4.dp_ack_seq =
243 cpu_to_be64(rds_ib_piggyb_ack(ic));
244 dp->ricp_v4.dp_cmn.ricpc_dp_toss = conn->c_tos;
245
246 conn_param->private_data = &dp->ricp_v4;
247 conn_param->private_data_len = sizeof(dp->ricp_v4);
248 }
249
250
251 if (ic->i_flowctl) {
252 unsigned int credits;
253
254 credits = IB_GET_POST_CREDITS
255 (atomic_read(&ic->i_credits));
256 if (isv6)
257 dp->ricp_v6.dp_credit = cpu_to_be32(credits);
258 else
259 dp->ricp_v4.dp_credit = cpu_to_be32(credits);
260 atomic_sub(IB_SET_POST_CREDITS(credits),
261 &ic->i_credits);
262 }
263 }
264 }
265
266 static void rds_ib_cq_event_handler(struct ib_event *event, void *data)
267 {
268 rdsdebug("event %u (%s) data %p\n",
269 event->event, ib_event_msg(event->event), data);
270 }
271
272
273
274
275
276
277
278
279
280 static void rds_ib_cq_comp_handler_recv(struct ib_cq *cq, void *context)
281 {
282 struct rds_connection *conn = context;
283 struct rds_ib_connection *ic = conn->c_transport_data;
284
285 rdsdebug("conn %p cq %p\n", conn, cq);
286
287 rds_ib_stats_inc(s_ib_evt_handler_call);
288
289 tasklet_schedule(&ic->i_recv_tasklet);
290 }
291
292 static void poll_scq(struct rds_ib_connection *ic, struct ib_cq *cq,
293 struct ib_wc *wcs)
294 {
295 int nr, i;
296 struct ib_wc *wc;
297
298 while ((nr = ib_poll_cq(cq, RDS_IB_WC_MAX, wcs)) > 0) {
299 for (i = 0; i < nr; i++) {
300 wc = wcs + i;
301 rdsdebug("wc wr_id 0x%llx status %u byte_len %u imm_data %u\n",
302 (unsigned long long)wc->wr_id, wc->status,
303 wc->byte_len, be32_to_cpu(wc->ex.imm_data));
304
305 if (wc->wr_id <= ic->i_send_ring.w_nr ||
306 wc->wr_id == RDS_IB_ACK_WR_ID)
307 rds_ib_send_cqe_handler(ic, wc);
308 else
309 rds_ib_mr_cqe_handler(ic, wc);
310
311 }
312 }
313 }
314
315 static void rds_ib_tasklet_fn_send(unsigned long data)
316 {
317 struct rds_ib_connection *ic = (struct rds_ib_connection *)data;
318 struct rds_connection *conn = ic->conn;
319
320 rds_ib_stats_inc(s_ib_tasklet_call);
321
322
323 if (atomic_read(&ic->i_cq_quiesce))
324 return;
325
326 poll_scq(ic, ic->i_send_cq, ic->i_send_wc);
327 ib_req_notify_cq(ic->i_send_cq, IB_CQ_NEXT_COMP);
328 poll_scq(ic, ic->i_send_cq, ic->i_send_wc);
329
330 if (rds_conn_up(conn) &&
331 (!test_bit(RDS_LL_SEND_FULL, &conn->c_flags) ||
332 test_bit(0, &conn->c_map_queued)))
333 rds_send_xmit(&ic->conn->c_path[0]);
334 }
335
336 static void poll_rcq(struct rds_ib_connection *ic, struct ib_cq *cq,
337 struct ib_wc *wcs,
338 struct rds_ib_ack_state *ack_state)
339 {
340 int nr, i;
341 struct ib_wc *wc;
342
343 while ((nr = ib_poll_cq(cq, RDS_IB_WC_MAX, wcs)) > 0) {
344 for (i = 0; i < nr; i++) {
345 wc = wcs + i;
346 rdsdebug("wc wr_id 0x%llx status %u byte_len %u imm_data %u\n",
347 (unsigned long long)wc->wr_id, wc->status,
348 wc->byte_len, be32_to_cpu(wc->ex.imm_data));
349
350 rds_ib_recv_cqe_handler(ic, wc, ack_state);
351 }
352 }
353 }
354
355 static void rds_ib_tasklet_fn_recv(unsigned long data)
356 {
357 struct rds_ib_connection *ic = (struct rds_ib_connection *)data;
358 struct rds_connection *conn = ic->conn;
359 struct rds_ib_device *rds_ibdev = ic->rds_ibdev;
360 struct rds_ib_ack_state state;
361
362 if (!rds_ibdev)
363 rds_conn_drop(conn);
364
365 rds_ib_stats_inc(s_ib_tasklet_call);
366
367
368 if (atomic_read(&ic->i_cq_quiesce))
369 return;
370
371 memset(&state, 0, sizeof(state));
372 poll_rcq(ic, ic->i_recv_cq, ic->i_recv_wc, &state);
373 ib_req_notify_cq(ic->i_recv_cq, IB_CQ_SOLICITED);
374 poll_rcq(ic, ic->i_recv_cq, ic->i_recv_wc, &state);
375
376 if (state.ack_next_valid)
377 rds_ib_set_ack(ic, state.ack_next, state.ack_required);
378 if (state.ack_recv_valid && state.ack_recv > ic->i_ack_recv) {
379 rds_send_drop_acked(conn, state.ack_recv, NULL);
380 ic->i_ack_recv = state.ack_recv;
381 }
382
383 if (rds_conn_up(conn))
384 rds_ib_attempt_ack(ic);
385 }
386
387 static void rds_ib_qp_event_handler(struct ib_event *event, void *data)
388 {
389 struct rds_connection *conn = data;
390 struct rds_ib_connection *ic = conn->c_transport_data;
391
392 rdsdebug("conn %p ic %p event %u (%s)\n", conn, ic, event->event,
393 ib_event_msg(event->event));
394
395 switch (event->event) {
396 case IB_EVENT_COMM_EST:
397 rdma_notify(ic->i_cm_id, IB_EVENT_COMM_EST);
398 break;
399 default:
400 rdsdebug("Fatal QP Event %u (%s) - connection %pI6c->%pI6c, reconnecting\n",
401 event->event, ib_event_msg(event->event),
402 &conn->c_laddr, &conn->c_faddr);
403 rds_conn_drop(conn);
404 break;
405 }
406 }
407
408 static void rds_ib_cq_comp_handler_send(struct ib_cq *cq, void *context)
409 {
410 struct rds_connection *conn = context;
411 struct rds_ib_connection *ic = conn->c_transport_data;
412
413 rdsdebug("conn %p cq %p\n", conn, cq);
414
415 rds_ib_stats_inc(s_ib_evt_handler_call);
416
417 tasklet_schedule(&ic->i_send_tasklet);
418 }
419
420 static inline int ibdev_get_unused_vector(struct rds_ib_device *rds_ibdev)
421 {
422 int min = rds_ibdev->vector_load[rds_ibdev->dev->num_comp_vectors - 1];
423 int index = rds_ibdev->dev->num_comp_vectors - 1;
424 int i;
425
426 for (i = rds_ibdev->dev->num_comp_vectors - 1; i >= 0; i--) {
427 if (rds_ibdev->vector_load[i] < min) {
428 index = i;
429 min = rds_ibdev->vector_load[i];
430 }
431 }
432
433 rds_ibdev->vector_load[index]++;
434 return index;
435 }
436
437 static inline void ibdev_put_vector(struct rds_ib_device *rds_ibdev, int index)
438 {
439 rds_ibdev->vector_load[index]--;
440 }
441
442
443
444
445
446 static int rds_ib_setup_qp(struct rds_connection *conn)
447 {
448 struct rds_ib_connection *ic = conn->c_transport_data;
449 struct ib_device *dev = ic->i_cm_id->device;
450 struct ib_qp_init_attr attr;
451 struct ib_cq_init_attr cq_attr = {};
452 struct rds_ib_device *rds_ibdev;
453 unsigned long max_wrs;
454 int ret, fr_queue_space;
455
456
457
458
459
460 rds_ibdev = rds_ib_get_client_data(dev);
461 if (!rds_ibdev)
462 return -EOPNOTSUPP;
463
464
465
466
467
468 fr_queue_space = (rds_ibdev->use_fastreg ? RDS_IB_DEFAULT_FR_WR : 0);
469
470
471 rds_ib_add_conn(rds_ibdev, conn);
472
473 max_wrs = rds_ibdev->max_wrs < rds_ib_sysctl_max_send_wr + 1 ?
474 rds_ibdev->max_wrs - 1 : rds_ib_sysctl_max_send_wr;
475 if (ic->i_send_ring.w_nr != max_wrs)
476 rds_ib_ring_resize(&ic->i_send_ring, max_wrs);
477
478 max_wrs = rds_ibdev->max_wrs < rds_ib_sysctl_max_recv_wr + 1 ?
479 rds_ibdev->max_wrs - 1 : rds_ib_sysctl_max_recv_wr;
480 if (ic->i_recv_ring.w_nr != max_wrs)
481 rds_ib_ring_resize(&ic->i_recv_ring, max_wrs);
482
483
484 ic->i_pd = rds_ibdev->pd;
485
486 ic->i_scq_vector = ibdev_get_unused_vector(rds_ibdev);
487 cq_attr.cqe = ic->i_send_ring.w_nr + fr_queue_space + 1;
488 cq_attr.comp_vector = ic->i_scq_vector;
489 ic->i_send_cq = ib_create_cq(dev, rds_ib_cq_comp_handler_send,
490 rds_ib_cq_event_handler, conn,
491 &cq_attr);
492 if (IS_ERR(ic->i_send_cq)) {
493 ret = PTR_ERR(ic->i_send_cq);
494 ic->i_send_cq = NULL;
495 ibdev_put_vector(rds_ibdev, ic->i_scq_vector);
496 rdsdebug("ib_create_cq send failed: %d\n", ret);
497 goto rds_ibdev_out;
498 }
499
500 ic->i_rcq_vector = ibdev_get_unused_vector(rds_ibdev);
501 cq_attr.cqe = ic->i_recv_ring.w_nr;
502 cq_attr.comp_vector = ic->i_rcq_vector;
503 ic->i_recv_cq = ib_create_cq(dev, rds_ib_cq_comp_handler_recv,
504 rds_ib_cq_event_handler, conn,
505 &cq_attr);
506 if (IS_ERR(ic->i_recv_cq)) {
507 ret = PTR_ERR(ic->i_recv_cq);
508 ic->i_recv_cq = NULL;
509 ibdev_put_vector(rds_ibdev, ic->i_rcq_vector);
510 rdsdebug("ib_create_cq recv failed: %d\n", ret);
511 goto send_cq_out;
512 }
513
514 ret = ib_req_notify_cq(ic->i_send_cq, IB_CQ_NEXT_COMP);
515 if (ret) {
516 rdsdebug("ib_req_notify_cq send failed: %d\n", ret);
517 goto recv_cq_out;
518 }
519
520 ret = ib_req_notify_cq(ic->i_recv_cq, IB_CQ_SOLICITED);
521 if (ret) {
522 rdsdebug("ib_req_notify_cq recv failed: %d\n", ret);
523 goto recv_cq_out;
524 }
525
526
527 memset(&attr, 0, sizeof(attr));
528 attr.event_handler = rds_ib_qp_event_handler;
529 attr.qp_context = conn;
530
531 attr.cap.max_send_wr = ic->i_send_ring.w_nr + fr_queue_space + 1;
532 attr.cap.max_recv_wr = ic->i_recv_ring.w_nr + 1;
533 attr.cap.max_send_sge = rds_ibdev->max_sge;
534 attr.cap.max_recv_sge = RDS_IB_RECV_SGE;
535 attr.sq_sig_type = IB_SIGNAL_REQ_WR;
536 attr.qp_type = IB_QPT_RC;
537 attr.send_cq = ic->i_send_cq;
538 attr.recv_cq = ic->i_recv_cq;
539
540
541
542
543
544 ret = rdma_create_qp(ic->i_cm_id, ic->i_pd, &attr);
545 if (ret) {
546 rdsdebug("rdma_create_qp failed: %d\n", ret);
547 goto recv_cq_out;
548 }
549
550 ic->i_send_hdrs = ib_dma_alloc_coherent(dev,
551 ic->i_send_ring.w_nr *
552 sizeof(struct rds_header),
553 &ic->i_send_hdrs_dma, GFP_KERNEL);
554 if (!ic->i_send_hdrs) {
555 ret = -ENOMEM;
556 rdsdebug("ib_dma_alloc_coherent send failed\n");
557 goto qp_out;
558 }
559
560 ic->i_recv_hdrs = ib_dma_alloc_coherent(dev,
561 ic->i_recv_ring.w_nr *
562 sizeof(struct rds_header),
563 &ic->i_recv_hdrs_dma, GFP_KERNEL);
564 if (!ic->i_recv_hdrs) {
565 ret = -ENOMEM;
566 rdsdebug("ib_dma_alloc_coherent recv failed\n");
567 goto send_hdrs_dma_out;
568 }
569
570 ic->i_ack = ib_dma_alloc_coherent(dev, sizeof(struct rds_header),
571 &ic->i_ack_dma, GFP_KERNEL);
572 if (!ic->i_ack) {
573 ret = -ENOMEM;
574 rdsdebug("ib_dma_alloc_coherent ack failed\n");
575 goto recv_hdrs_dma_out;
576 }
577
578 ic->i_sends = vzalloc_node(array_size(sizeof(struct rds_ib_send_work),
579 ic->i_send_ring.w_nr),
580 ibdev_to_node(dev));
581 if (!ic->i_sends) {
582 ret = -ENOMEM;
583 rdsdebug("send allocation failed\n");
584 goto ack_dma_out;
585 }
586
587 ic->i_recvs = vzalloc_node(array_size(sizeof(struct rds_ib_recv_work),
588 ic->i_recv_ring.w_nr),
589 ibdev_to_node(dev));
590 if (!ic->i_recvs) {
591 ret = -ENOMEM;
592 rdsdebug("recv allocation failed\n");
593 goto sends_out;
594 }
595
596 rds_ib_recv_init_ack(ic);
597
598 rdsdebug("conn %p pd %p cq %p %p\n", conn, ic->i_pd,
599 ic->i_send_cq, ic->i_recv_cq);
600
601 goto out;
602
603 sends_out:
604 vfree(ic->i_sends);
605 ack_dma_out:
606 ib_dma_free_coherent(dev, sizeof(struct rds_header),
607 ic->i_ack, ic->i_ack_dma);
608 recv_hdrs_dma_out:
609 ib_dma_free_coherent(dev, ic->i_recv_ring.w_nr *
610 sizeof(struct rds_header),
611 ic->i_recv_hdrs, ic->i_recv_hdrs_dma);
612 send_hdrs_dma_out:
613 ib_dma_free_coherent(dev, ic->i_send_ring.w_nr *
614 sizeof(struct rds_header),
615 ic->i_send_hdrs, ic->i_send_hdrs_dma);
616 qp_out:
617 rdma_destroy_qp(ic->i_cm_id);
618 recv_cq_out:
619 ib_destroy_cq(ic->i_recv_cq);
620 ic->i_recv_cq = NULL;
621 send_cq_out:
622 ib_destroy_cq(ic->i_send_cq);
623 ic->i_send_cq = NULL;
624 rds_ibdev_out:
625 rds_ib_remove_conn(rds_ibdev, conn);
626 out:
627 rds_ib_dev_put(rds_ibdev);
628
629 return ret;
630 }
631
632 static u32 rds_ib_protocol_compatible(struct rdma_cm_event *event, bool isv6)
633 {
634 const union rds_ib_conn_priv *dp = event->param.conn.private_data;
635 u8 data_len, major, minor;
636 u32 version = 0;
637 __be16 mask;
638 u16 common;
639
640
641
642
643
644
645
646
647
648
649
650
651 if (!event->param.conn.private_data_len) {
652 printk(KERN_NOTICE "RDS incoming connection has no private data, "
653 "rejecting\n");
654 return 0;
655 }
656
657 if (isv6) {
658 data_len = sizeof(struct rds6_ib_connect_private);
659 major = dp->ricp_v6.dp_protocol_major;
660 minor = dp->ricp_v6.dp_protocol_minor;
661 mask = dp->ricp_v6.dp_protocol_minor_mask;
662 } else {
663 data_len = sizeof(struct rds_ib_connect_private);
664 major = dp->ricp_v4.dp_protocol_major;
665 minor = dp->ricp_v4.dp_protocol_minor;
666 mask = dp->ricp_v4.dp_protocol_minor_mask;
667 }
668
669
670 if (event->param.conn.private_data_len < data_len || major == 0)
671 return RDS_PROTOCOL_4_0;
672
673 common = be16_to_cpu(mask) & RDS_IB_SUPPORTED_PROTOCOLS;
674 if (major == 4 && common) {
675 version = RDS_PROTOCOL_4_0;
676 while ((common >>= 1) != 0)
677 version++;
678 } else if (RDS_PROTOCOL_COMPAT_VERSION ==
679 RDS_PROTOCOL(major, minor)) {
680 version = RDS_PROTOCOL_COMPAT_VERSION;
681 } else {
682 if (isv6)
683 printk_ratelimited(KERN_NOTICE "RDS: Connection from %pI6c using incompatible protocol version %u.%u\n",
684 &dp->ricp_v6.dp_saddr, major, minor);
685 else
686 printk_ratelimited(KERN_NOTICE "RDS: Connection from %pI4 using incompatible protocol version %u.%u\n",
687 &dp->ricp_v4.dp_saddr, major, minor);
688 }
689 return version;
690 }
691
692 #if IS_ENABLED(CONFIG_IPV6)
693
694
695
696
697
698
699
700
701
702
703 static u32 __rds_find_ifindex(struct net *net, const struct in6_addr *addr)
704 {
705 struct net_device *dev;
706 int idx = 0;
707
708 rcu_read_lock();
709 for_each_netdev_rcu(net, dev) {
710 if (ipv6_chk_addr(net, addr, dev, 1)) {
711 idx = dev->ifindex;
712 break;
713 }
714 }
715 rcu_read_unlock();
716
717 return idx;
718 }
719 #endif
720
721 int rds_ib_cm_handle_connect(struct rdma_cm_id *cm_id,
722 struct rdma_cm_event *event, bool isv6)
723 {
724 __be64 lguid = cm_id->route.path_rec->sgid.global.interface_id;
725 __be64 fguid = cm_id->route.path_rec->dgid.global.interface_id;
726 const struct rds_ib_conn_priv_cmn *dp_cmn;
727 struct rds_connection *conn = NULL;
728 struct rds_ib_connection *ic = NULL;
729 struct rdma_conn_param conn_param;
730 const union rds_ib_conn_priv *dp;
731 union rds_ib_conn_priv dp_rep;
732 struct in6_addr s_mapped_addr;
733 struct in6_addr d_mapped_addr;
734 const struct in6_addr *saddr6;
735 const struct in6_addr *daddr6;
736 int destroy = 1;
737 u32 ifindex = 0;
738 u32 version;
739 int err = 1;
740
741
742 version = rds_ib_protocol_compatible(event, isv6);
743 if (!version) {
744 err = RDS_RDMA_REJ_INCOMPAT;
745 goto out;
746 }
747
748 dp = event->param.conn.private_data;
749 if (isv6) {
750 #if IS_ENABLED(CONFIG_IPV6)
751 dp_cmn = &dp->ricp_v6.dp_cmn;
752 saddr6 = &dp->ricp_v6.dp_saddr;
753 daddr6 = &dp->ricp_v6.dp_daddr;
754
755
756
757
758 if (ipv6_addr_type(daddr6) & IPV6_ADDR_LINKLOCAL) {
759
760 ifindex = __rds_find_ifindex(&init_net, daddr6);
761
762 if (ifindex == 0) {
763 err = -EOPNOTSUPP;
764 goto out;
765 }
766 } else if (ipv6_addr_type(saddr6) & IPV6_ADDR_LINKLOCAL) {
767
768 ifindex = __rds_find_ifindex(&init_net, daddr6);
769
770 if (ifindex == 0) {
771 err = -EOPNOTSUPP;
772 goto out;
773 }
774 }
775 #else
776 err = -EOPNOTSUPP;
777 goto out;
778 #endif
779 } else {
780 dp_cmn = &dp->ricp_v4.dp_cmn;
781 ipv6_addr_set_v4mapped(dp->ricp_v4.dp_saddr, &s_mapped_addr);
782 ipv6_addr_set_v4mapped(dp->ricp_v4.dp_daddr, &d_mapped_addr);
783 saddr6 = &s_mapped_addr;
784 daddr6 = &d_mapped_addr;
785 }
786
787 rdsdebug("saddr %pI6c daddr %pI6c RDSv%u.%u lguid 0x%llx fguid 0x%llx, tos:%d\n",
788 saddr6, daddr6, RDS_PROTOCOL_MAJOR(version),
789 RDS_PROTOCOL_MINOR(version),
790 (unsigned long long)be64_to_cpu(lguid),
791 (unsigned long long)be64_to_cpu(fguid), dp_cmn->ricpc_dp_toss);
792
793
794 conn = rds_conn_create(&init_net, daddr6, saddr6,
795 &rds_ib_transport, dp_cmn->ricpc_dp_toss,
796 GFP_KERNEL, ifindex);
797 if (IS_ERR(conn)) {
798 rdsdebug("rds_conn_create failed (%ld)\n", PTR_ERR(conn));
799 conn = NULL;
800 goto out;
801 }
802
803
804
805
806
807
808
809
810 mutex_lock(&conn->c_cm_lock);
811 if (!rds_conn_transition(conn, RDS_CONN_DOWN, RDS_CONN_CONNECTING)) {
812 if (rds_conn_state(conn) == RDS_CONN_UP) {
813 rdsdebug("incoming connect while connecting\n");
814 rds_conn_drop(conn);
815 rds_ib_stats_inc(s_ib_listen_closed_stale);
816 } else
817 if (rds_conn_state(conn) == RDS_CONN_CONNECTING) {
818
819 rds_ib_stats_inc(s_ib_connect_raced);
820 }
821 goto out;
822 }
823
824 ic = conn->c_transport_data;
825
826 rds_ib_set_protocol(conn, version);
827 rds_ib_set_flow_control(conn, be32_to_cpu(dp_cmn->ricpc_credit));
828
829
830
831 if (dp_cmn->ricpc_ack_seq)
832 rds_send_drop_acked(conn, be64_to_cpu(dp_cmn->ricpc_ack_seq),
833 NULL);
834
835 BUG_ON(cm_id->context);
836 BUG_ON(ic->i_cm_id);
837
838 ic->i_cm_id = cm_id;
839 cm_id->context = conn;
840
841
842
843 destroy = 0;
844
845 err = rds_ib_setup_qp(conn);
846 if (err) {
847 rds_ib_conn_error(conn, "rds_ib_setup_qp failed (%d)\n", err);
848 goto out;
849 }
850
851 rds_ib_cm_fill_conn_param(conn, &conn_param, &dp_rep, version,
852 event->param.conn.responder_resources,
853 event->param.conn.initiator_depth, isv6);
854
855
856 if (rdma_accept(cm_id, &conn_param))
857 rds_ib_conn_error(conn, "rdma_accept failed\n");
858
859 out:
860 if (conn)
861 mutex_unlock(&conn->c_cm_lock);
862 if (err)
863 rdma_reject(cm_id, &err, sizeof(int));
864 return destroy;
865 }
866
867
868 int rds_ib_cm_initiate_connect(struct rdma_cm_id *cm_id, bool isv6)
869 {
870 struct rds_connection *conn = cm_id->context;
871 struct rds_ib_connection *ic = conn->c_transport_data;
872 struct rdma_conn_param conn_param;
873 union rds_ib_conn_priv dp;
874 int ret;
875
876
877
878 rds_ib_set_protocol(conn, RDS_PROTOCOL_4_1);
879 ic->i_flowctl = rds_ib_sysctl_flow_control;
880
881 ret = rds_ib_setup_qp(conn);
882 if (ret) {
883 rds_ib_conn_error(conn, "rds_ib_setup_qp failed (%d)\n", ret);
884 goto out;
885 }
886
887 rds_ib_cm_fill_conn_param(conn, &conn_param, &dp,
888 conn->c_proposed_version,
889 UINT_MAX, UINT_MAX, isv6);
890 ret = rdma_connect(cm_id, &conn_param);
891 if (ret)
892 rds_ib_conn_error(conn, "rdma_connect failed (%d)\n", ret);
893
894 out:
895
896
897
898 if (ret) {
899 if (ic->i_cm_id == cm_id)
900 ret = 0;
901 }
902 ic->i_active_side = true;
903 return ret;
904 }
905
906 int rds_ib_conn_path_connect(struct rds_conn_path *cp)
907 {
908 struct rds_connection *conn = cp->cp_conn;
909 struct sockaddr_storage src, dest;
910 rdma_cm_event_handler handler;
911 struct rds_ib_connection *ic;
912 int ret;
913
914 ic = conn->c_transport_data;
915
916
917
918 #if IS_ENABLED(CONFIG_IPV6)
919 if (conn->c_isv6)
920 handler = rds6_rdma_cm_event_handler;
921 else
922 #endif
923 handler = rds_rdma_cm_event_handler;
924 ic->i_cm_id = rdma_create_id(&init_net, handler, conn,
925 RDMA_PS_TCP, IB_QPT_RC);
926 if (IS_ERR(ic->i_cm_id)) {
927 ret = PTR_ERR(ic->i_cm_id);
928 ic->i_cm_id = NULL;
929 rdsdebug("rdma_create_id() failed: %d\n", ret);
930 goto out;
931 }
932
933 rdsdebug("created cm id %p for conn %p\n", ic->i_cm_id, conn);
934
935 if (ipv6_addr_v4mapped(&conn->c_faddr)) {
936 struct sockaddr_in *sin;
937
938 sin = (struct sockaddr_in *)&src;
939 sin->sin_family = AF_INET;
940 sin->sin_addr.s_addr = conn->c_laddr.s6_addr32[3];
941 sin->sin_port = 0;
942
943 sin = (struct sockaddr_in *)&dest;
944 sin->sin_family = AF_INET;
945 sin->sin_addr.s_addr = conn->c_faddr.s6_addr32[3];
946 sin->sin_port = htons(RDS_PORT);
947 } else {
948 struct sockaddr_in6 *sin6;
949
950 sin6 = (struct sockaddr_in6 *)&src;
951 sin6->sin6_family = AF_INET6;
952 sin6->sin6_addr = conn->c_laddr;
953 sin6->sin6_port = 0;
954 sin6->sin6_scope_id = conn->c_dev_if;
955
956 sin6 = (struct sockaddr_in6 *)&dest;
957 sin6->sin6_family = AF_INET6;
958 sin6->sin6_addr = conn->c_faddr;
959 sin6->sin6_port = htons(RDS_CM_PORT);
960 sin6->sin6_scope_id = conn->c_dev_if;
961 }
962
963 ret = rdma_resolve_addr(ic->i_cm_id, (struct sockaddr *)&src,
964 (struct sockaddr *)&dest,
965 RDS_RDMA_RESOLVE_TIMEOUT_MS);
966 if (ret) {
967 rdsdebug("addr resolve failed for cm id %p: %d\n", ic->i_cm_id,
968 ret);
969 rdma_destroy_id(ic->i_cm_id);
970 ic->i_cm_id = NULL;
971 }
972
973 out:
974 return ret;
975 }
976
977
978
979
980
981
982 void rds_ib_conn_path_shutdown(struct rds_conn_path *cp)
983 {
984 struct rds_connection *conn = cp->cp_conn;
985 struct rds_ib_connection *ic = conn->c_transport_data;
986 int err = 0;
987
988 rdsdebug("cm %p pd %p cq %p %p qp %p\n", ic->i_cm_id,
989 ic->i_pd, ic->i_send_cq, ic->i_recv_cq,
990 ic->i_cm_id ? ic->i_cm_id->qp : NULL);
991
992 if (ic->i_cm_id) {
993 struct ib_device *dev = ic->i_cm_id->device;
994
995 rdsdebug("disconnecting cm %p\n", ic->i_cm_id);
996 err = rdma_disconnect(ic->i_cm_id);
997 if (err) {
998
999
1000
1001 rdsdebug("failed to disconnect, cm: %p err %d\n",
1002 ic->i_cm_id, err);
1003 }
1004
1005
1006
1007
1008 rds_ib_flush_mrs();
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019 wait_event(rds_ib_ring_empty_wait,
1020 rds_ib_ring_empty(&ic->i_recv_ring) &&
1021 (atomic_read(&ic->i_signaled_sends) == 0) &&
1022 (atomic_read(&ic->i_fastreg_inuse_count) == 0) &&
1023 (atomic_read(&ic->i_fastreg_wrs) == RDS_IB_DEFAULT_FR_WR));
1024 tasklet_kill(&ic->i_send_tasklet);
1025 tasklet_kill(&ic->i_recv_tasklet);
1026
1027 atomic_set(&ic->i_cq_quiesce, 1);
1028
1029
1030 if (ic->i_cm_id->qp)
1031 rdma_destroy_qp(ic->i_cm_id);
1032 if (ic->i_send_cq) {
1033 if (ic->rds_ibdev)
1034 ibdev_put_vector(ic->rds_ibdev, ic->i_scq_vector);
1035 ib_destroy_cq(ic->i_send_cq);
1036 }
1037
1038 if (ic->i_recv_cq) {
1039 if (ic->rds_ibdev)
1040 ibdev_put_vector(ic->rds_ibdev, ic->i_rcq_vector);
1041 ib_destroy_cq(ic->i_recv_cq);
1042 }
1043
1044
1045 if (ic->i_send_hdrs)
1046 ib_dma_free_coherent(dev,
1047 ic->i_send_ring.w_nr *
1048 sizeof(struct rds_header),
1049 ic->i_send_hdrs,
1050 ic->i_send_hdrs_dma);
1051
1052 if (ic->i_recv_hdrs)
1053 ib_dma_free_coherent(dev,
1054 ic->i_recv_ring.w_nr *
1055 sizeof(struct rds_header),
1056 ic->i_recv_hdrs,
1057 ic->i_recv_hdrs_dma);
1058
1059 if (ic->i_ack)
1060 ib_dma_free_coherent(dev, sizeof(struct rds_header),
1061 ic->i_ack, ic->i_ack_dma);
1062
1063 if (ic->i_sends)
1064 rds_ib_send_clear_ring(ic);
1065 if (ic->i_recvs)
1066 rds_ib_recv_clear_ring(ic);
1067
1068 rdma_destroy_id(ic->i_cm_id);
1069
1070
1071
1072
1073 if (ic->rds_ibdev)
1074 rds_ib_remove_conn(ic->rds_ibdev, conn);
1075
1076 ic->i_cm_id = NULL;
1077 ic->i_pd = NULL;
1078 ic->i_send_cq = NULL;
1079 ic->i_recv_cq = NULL;
1080 ic->i_send_hdrs = NULL;
1081 ic->i_recv_hdrs = NULL;
1082 ic->i_ack = NULL;
1083 }
1084 BUG_ON(ic->rds_ibdev);
1085
1086
1087 if (ic->i_data_op) {
1088 struct rds_message *rm;
1089
1090 rm = container_of(ic->i_data_op, struct rds_message, data);
1091 rds_message_put(rm);
1092 ic->i_data_op = NULL;
1093 }
1094
1095
1096 clear_bit(IB_ACK_IN_FLIGHT, &ic->i_ack_flags);
1097 #ifdef KERNEL_HAS_ATOMIC64
1098 atomic64_set(&ic->i_ack_next, 0);
1099 #else
1100 ic->i_ack_next = 0;
1101 #endif
1102 ic->i_ack_recv = 0;
1103
1104
1105 ic->i_flowctl = 0;
1106 atomic_set(&ic->i_credits, 0);
1107
1108
1109 rds_ib_ring_init(&ic->i_send_ring, ic->i_send_ring.w_nr);
1110 rds_ib_ring_init(&ic->i_recv_ring, ic->i_recv_ring.w_nr);
1111
1112 if (ic->i_ibinc) {
1113 rds_inc_put(&ic->i_ibinc->ii_inc);
1114 ic->i_ibinc = NULL;
1115 }
1116
1117 vfree(ic->i_sends);
1118 ic->i_sends = NULL;
1119 vfree(ic->i_recvs);
1120 ic->i_recvs = NULL;
1121 ic->i_active_side = false;
1122 }
1123
1124 int rds_ib_conn_alloc(struct rds_connection *conn, gfp_t gfp)
1125 {
1126 struct rds_ib_connection *ic;
1127 unsigned long flags;
1128 int ret;
1129
1130
1131 ic = kzalloc(sizeof(struct rds_ib_connection), gfp);
1132 if (!ic)
1133 return -ENOMEM;
1134
1135 ret = rds_ib_recv_alloc_caches(ic, gfp);
1136 if (ret) {
1137 kfree(ic);
1138 return ret;
1139 }
1140
1141 INIT_LIST_HEAD(&ic->ib_node);
1142 tasklet_init(&ic->i_send_tasklet, rds_ib_tasklet_fn_send,
1143 (unsigned long)ic);
1144 tasklet_init(&ic->i_recv_tasklet, rds_ib_tasklet_fn_recv,
1145 (unsigned long)ic);
1146 mutex_init(&ic->i_recv_mutex);
1147 #ifndef KERNEL_HAS_ATOMIC64
1148 spin_lock_init(&ic->i_ack_lock);
1149 #endif
1150 atomic_set(&ic->i_signaled_sends, 0);
1151 atomic_set(&ic->i_fastreg_wrs, RDS_IB_DEFAULT_FR_WR);
1152
1153
1154
1155
1156
1157 rds_ib_ring_init(&ic->i_send_ring, 0);
1158 rds_ib_ring_init(&ic->i_recv_ring, 0);
1159
1160 ic->conn = conn;
1161 conn->c_transport_data = ic;
1162
1163 spin_lock_irqsave(&ib_nodev_conns_lock, flags);
1164 list_add_tail(&ic->ib_node, &ib_nodev_conns);
1165 spin_unlock_irqrestore(&ib_nodev_conns_lock, flags);
1166
1167
1168 rdsdebug("conn %p conn ic %p\n", conn, conn->c_transport_data);
1169 return 0;
1170 }
1171
1172
1173
1174
1175 void rds_ib_conn_free(void *arg)
1176 {
1177 struct rds_ib_connection *ic = arg;
1178 spinlock_t *lock_ptr;
1179
1180 rdsdebug("ic %p\n", ic);
1181
1182
1183
1184
1185
1186
1187 lock_ptr = ic->rds_ibdev ? &ic->rds_ibdev->spinlock : &ib_nodev_conns_lock;
1188
1189 spin_lock_irq(lock_ptr);
1190 list_del(&ic->ib_node);
1191 spin_unlock_irq(lock_ptr);
1192
1193 rds_ib_recv_free_caches(ic);
1194
1195 kfree(ic);
1196 }
1197
1198
1199
1200
1201
1202 void
1203 __rds_ib_conn_error(struct rds_connection *conn, const char *fmt, ...)
1204 {
1205 va_list ap;
1206
1207 rds_conn_drop(conn);
1208
1209 va_start(ap, fmt);
1210 vprintk(fmt, ap);
1211 va_end(ap);
1212 }