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
34
35
36
37
38
39
40
41
42#include <linux/sunrpc/debug.h>
43#include <linux/sunrpc/rpc_rdma.h>
44#include <linux/spinlock.h>
45#include <asm/unaligned.h>
46#include <rdma/ib_verbs.h>
47#include <rdma/rdma_cm.h>
48#include <linux/sunrpc/svc_rdma.h>
49
50#define RPCDBG_FACILITY RPCDBG_SVCXPRT
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72static int fast_reg_xdr(struct svcxprt_rdma *xprt,
73 struct xdr_buf *xdr,
74 struct svc_rdma_req_map *vec)
75{
76 int sge_no;
77 u32 sge_bytes;
78 u32 page_bytes;
79 u32 page_off;
80 int page_no = 0;
81 u8 *frva;
82 struct svc_rdma_fastreg_mr *frmr;
83
84 frmr = svc_rdma_get_frmr(xprt);
85 if (IS_ERR(frmr))
86 return -ENOMEM;
87 vec->frmr = frmr;
88
89
90 sge_no = 1;
91
92
93 frva = (void *)((unsigned long)(xdr->head[0].iov_base) & PAGE_MASK);
94 vec->sge[sge_no].iov_base = xdr->head[0].iov_base;
95 vec->sge[sge_no].iov_len = xdr->head[0].iov_len;
96 vec->count = 2;
97 sge_no++;
98
99
100 frmr->kva = frva;
101 frmr->direction = DMA_TO_DEVICE;
102 frmr->access_flags = 0;
103 frmr->map_len = PAGE_SIZE;
104 frmr->page_list_len = 1;
105 frmr->page_list->page_list[page_no] =
106 ib_dma_map_single(xprt->sc_cm_id->device,
107 (void *)xdr->head[0].iov_base,
108 PAGE_SIZE, DMA_TO_DEVICE);
109 if (ib_dma_mapping_error(xprt->sc_cm_id->device,
110 frmr->page_list->page_list[page_no]))
111 goto fatal_err;
112 atomic_inc(&xprt->sc_dma_used);
113
114 page_off = xdr->page_base;
115 page_bytes = xdr->page_len + page_off;
116 if (!page_bytes)
117 goto encode_tail;
118
119
120 vec->sge[sge_no].iov_base = frva + frmr->map_len + page_off;
121 vec->sge[sge_no].iov_len = page_bytes;
122 sge_no++;
123 while (page_bytes) {
124 struct page *page;
125
126 page = xdr->pages[page_no++];
127 sge_bytes = min_t(u32, page_bytes, (PAGE_SIZE - page_off));
128 page_bytes -= sge_bytes;
129
130 frmr->page_list->page_list[page_no] =
131 ib_dma_map_single(xprt->sc_cm_id->device,
132 page_address(page),
133 PAGE_SIZE, DMA_TO_DEVICE);
134 if (ib_dma_mapping_error(xprt->sc_cm_id->device,
135 frmr->page_list->page_list[page_no]))
136 goto fatal_err;
137
138 atomic_inc(&xprt->sc_dma_used);
139 page_off = 0;
140 frmr->map_len += PAGE_SIZE;
141 frmr->page_list_len++;
142 }
143 vec->count++;
144
145 encode_tail:
146
147 if (0 == xdr->tail[0].iov_len)
148 goto done;
149
150 vec->count++;
151 vec->sge[sge_no].iov_len = xdr->tail[0].iov_len;
152
153 if (((unsigned long)xdr->tail[0].iov_base & PAGE_MASK) ==
154 ((unsigned long)xdr->head[0].iov_base & PAGE_MASK)) {
155
156
157
158
159 vec->sge[sge_no].iov_base = xdr->tail[0].iov_base;
160 } else {
161 void *va;
162
163
164 page_off = (unsigned long)xdr->tail[0].iov_base & ~PAGE_MASK;
165 va = (void *)((unsigned long)xdr->tail[0].iov_base & PAGE_MASK);
166 vec->sge[sge_no].iov_base = frva + frmr->map_len + page_off;
167
168 frmr->page_list->page_list[page_no] =
169 ib_dma_map_single(xprt->sc_cm_id->device, va, PAGE_SIZE,
170 DMA_TO_DEVICE);
171 if (ib_dma_mapping_error(xprt->sc_cm_id->device,
172 frmr->page_list->page_list[page_no]))
173 goto fatal_err;
174 atomic_inc(&xprt->sc_dma_used);
175 frmr->map_len += PAGE_SIZE;
176 frmr->page_list_len++;
177 }
178
179 done:
180 if (svc_rdma_fastreg(xprt, frmr))
181 goto fatal_err;
182
183 return 0;
184
185 fatal_err:
186 printk("svcrdma: Error fast registering memory for xprt %p\n", xprt);
187 vec->frmr = NULL;
188 svc_rdma_put_frmr(xprt, frmr);
189 return -EIO;
190}
191
192static int map_xdr(struct svcxprt_rdma *xprt,
193 struct xdr_buf *xdr,
194 struct svc_rdma_req_map *vec)
195{
196 int sge_no;
197 u32 sge_bytes;
198 u32 page_bytes;
199 u32 page_off;
200 int page_no;
201
202 BUG_ON(xdr->len !=
203 (xdr->head[0].iov_len + xdr->page_len + xdr->tail[0].iov_len));
204
205 if (xprt->sc_frmr_pg_list_len)
206 return fast_reg_xdr(xprt, xdr, vec);
207
208
209 sge_no = 1;
210
211
212 vec->sge[sge_no].iov_base = xdr->head[0].iov_base;
213 vec->sge[sge_no].iov_len = xdr->head[0].iov_len;
214 sge_no++;
215
216
217 page_no = 0;
218 page_bytes = xdr->page_len;
219 page_off = xdr->page_base;
220 while (page_bytes) {
221 vec->sge[sge_no].iov_base =
222 page_address(xdr->pages[page_no]) + page_off;
223 sge_bytes = min_t(u32, page_bytes, (PAGE_SIZE - page_off));
224 page_bytes -= sge_bytes;
225 vec->sge[sge_no].iov_len = sge_bytes;
226
227 sge_no++;
228 page_no++;
229 page_off = 0;
230 }
231
232
233 if (xdr->tail[0].iov_len) {
234 vec->sge[sge_no].iov_base = xdr->tail[0].iov_base;
235 vec->sge[sge_no].iov_len = xdr->tail[0].iov_len;
236 sge_no++;
237 }
238
239 dprintk("svcrdma: map_xdr: sge_no %d page_no %d "
240 "page_base %u page_len %u head_len %zu tail_len %zu\n",
241 sge_no, page_no, xdr->page_base, xdr->page_len,
242 xdr->head[0].iov_len, xdr->tail[0].iov_len);
243
244 vec->count = sge_no;
245 return 0;
246}
247
248
249
250
251
252
253static int send_write(struct svcxprt_rdma *xprt, struct svc_rqst *rqstp,
254 u32 rmr, u64 to,
255 u32 xdr_off, int write_len,
256 struct svc_rdma_req_map *vec)
257{
258 struct ib_send_wr write_wr;
259 struct ib_sge *sge;
260 int xdr_sge_no;
261 int sge_no;
262 int sge_bytes;
263 int sge_off;
264 int bc;
265 struct svc_rdma_op_ctxt *ctxt;
266
267 BUG_ON(vec->count > RPCSVC_MAXPAGES);
268 dprintk("svcrdma: RDMA_WRITE rmr=%x, to=%llx, xdr_off=%d, "
269 "write_len=%d, vec->sge=%p, vec->count=%lu\n",
270 rmr, (unsigned long long)to, xdr_off,
271 write_len, vec->sge, vec->count);
272
273 ctxt = svc_rdma_get_context(xprt);
274 ctxt->direction = DMA_TO_DEVICE;
275 sge = ctxt->sge;
276
277
278 for (bc = xdr_off, xdr_sge_no = 1; bc && xdr_sge_no < vec->count;
279 xdr_sge_no++) {
280 if (vec->sge[xdr_sge_no].iov_len > bc)
281 break;
282 bc -= vec->sge[xdr_sge_no].iov_len;
283 }
284
285 sge_off = bc;
286 bc = write_len;
287 sge_no = 0;
288
289
290 while (bc != 0) {
291 sge_bytes = min_t(size_t,
292 bc, vec->sge[xdr_sge_no].iov_len-sge_off);
293 sge[sge_no].length = sge_bytes;
294 if (!vec->frmr) {
295 sge[sge_no].addr =
296 ib_dma_map_single(xprt->sc_cm_id->device,
297 (void *)
298 vec->sge[xdr_sge_no].iov_base + sge_off,
299 sge_bytes, DMA_TO_DEVICE);
300 if (ib_dma_mapping_error(xprt->sc_cm_id->device,
301 sge[sge_no].addr))
302 goto err;
303 atomic_inc(&xprt->sc_dma_used);
304 sge[sge_no].lkey = xprt->sc_dma_lkey;
305 } else {
306 sge[sge_no].addr = (unsigned long)
307 vec->sge[xdr_sge_no].iov_base + sge_off;
308 sge[sge_no].lkey = vec->frmr->mr->lkey;
309 }
310 ctxt->count++;
311 ctxt->frmr = vec->frmr;
312 sge_off = 0;
313 sge_no++;
314 xdr_sge_no++;
315 BUG_ON(xdr_sge_no > vec->count);
316 bc -= sge_bytes;
317 }
318
319
320 memset(&write_wr, 0, sizeof write_wr);
321 ctxt->wr_op = IB_WR_RDMA_WRITE;
322 write_wr.wr_id = (unsigned long)ctxt;
323 write_wr.sg_list = &sge[0];
324 write_wr.num_sge = sge_no;
325 write_wr.opcode = IB_WR_RDMA_WRITE;
326 write_wr.send_flags = IB_SEND_SIGNALED;
327 write_wr.wr.rdma.rkey = rmr;
328 write_wr.wr.rdma.remote_addr = to;
329
330
331 atomic_inc(&rdma_stat_write);
332 if (svc_rdma_send(xprt, &write_wr))
333 goto err;
334 return 0;
335 err:
336 svc_rdma_put_context(ctxt, 0);
337
338 return -EIO;
339}
340
341static int send_write_chunks(struct svcxprt_rdma *xprt,
342 struct rpcrdma_msg *rdma_argp,
343 struct rpcrdma_msg *rdma_resp,
344 struct svc_rqst *rqstp,
345 struct svc_rdma_req_map *vec)
346{
347 u32 xfer_len = rqstp->rq_res.page_len + rqstp->rq_res.tail[0].iov_len;
348 int write_len;
349 int max_write;
350 u32 xdr_off;
351 int chunk_off;
352 int chunk_no;
353 struct rpcrdma_write_array *arg_ary;
354 struct rpcrdma_write_array *res_ary;
355 int ret;
356
357 arg_ary = svc_rdma_get_write_array(rdma_argp);
358 if (!arg_ary)
359 return 0;
360 res_ary = (struct rpcrdma_write_array *)
361 &rdma_resp->rm_body.rm_chunks[1];
362
363 if (vec->frmr)
364 max_write = vec->frmr->map_len;
365 else
366 max_write = xprt->sc_max_sge * PAGE_SIZE;
367
368
369 for (xdr_off = rqstp->rq_res.head[0].iov_len, chunk_no = 0;
370 xfer_len && chunk_no < arg_ary->wc_nchunks;
371 chunk_no++) {
372 struct rpcrdma_segment *arg_ch;
373 u64 rs_offset;
374
375 arg_ch = &arg_ary->wc_array[chunk_no].wc_target;
376 write_len = min(xfer_len, arg_ch->rs_length);
377
378
379
380 rs_offset = get_unaligned(&(arg_ch->rs_offset));
381 svc_rdma_xdr_encode_array_chunk(res_ary, chunk_no,
382 arg_ch->rs_handle,
383 rs_offset,
384 write_len);
385 chunk_off = 0;
386 while (write_len) {
387 int this_write;
388 this_write = min(write_len, max_write);
389 ret = send_write(xprt, rqstp,
390 arg_ch->rs_handle,
391 rs_offset + chunk_off,
392 xdr_off,
393 this_write,
394 vec);
395 if (ret) {
396 dprintk("svcrdma: RDMA_WRITE failed, ret=%d\n",
397 ret);
398 return -EIO;
399 }
400 chunk_off += this_write;
401 xdr_off += this_write;
402 xfer_len -= this_write;
403 write_len -= this_write;
404 }
405 }
406
407 svc_rdma_xdr_encode_write_list(rdma_resp, chunk_no);
408
409 return rqstp->rq_res.page_len + rqstp->rq_res.tail[0].iov_len;
410}
411
412static int send_reply_chunks(struct svcxprt_rdma *xprt,
413 struct rpcrdma_msg *rdma_argp,
414 struct rpcrdma_msg *rdma_resp,
415 struct svc_rqst *rqstp,
416 struct svc_rdma_req_map *vec)
417{
418 u32 xfer_len = rqstp->rq_res.len;
419 int write_len;
420 int max_write;
421 u32 xdr_off;
422 int chunk_no;
423 int chunk_off;
424 struct rpcrdma_segment *ch;
425 struct rpcrdma_write_array *arg_ary;
426 struct rpcrdma_write_array *res_ary;
427 int ret;
428
429 arg_ary = svc_rdma_get_reply_array(rdma_argp);
430 if (!arg_ary)
431 return 0;
432
433
434 res_ary = (struct rpcrdma_write_array *)
435 &rdma_resp->rm_body.rm_chunks[2];
436
437 if (vec->frmr)
438 max_write = vec->frmr->map_len;
439 else
440 max_write = xprt->sc_max_sge * PAGE_SIZE;
441
442
443 for (xdr_off = 0, chunk_no = 0;
444 xfer_len && chunk_no < arg_ary->wc_nchunks;
445 chunk_no++) {
446 u64 rs_offset;
447 ch = &arg_ary->wc_array[chunk_no].wc_target;
448 write_len = min(xfer_len, ch->rs_length);
449
450
451
452 rs_offset = get_unaligned(&(ch->rs_offset));
453 svc_rdma_xdr_encode_array_chunk(res_ary, chunk_no,
454 ch->rs_handle, rs_offset,
455 write_len);
456 chunk_off = 0;
457 while (write_len) {
458 int this_write;
459
460 this_write = min(write_len, max_write);
461 ret = send_write(xprt, rqstp,
462 ch->rs_handle,
463 rs_offset + chunk_off,
464 xdr_off,
465 this_write,
466 vec);
467 if (ret) {
468 dprintk("svcrdma: RDMA_WRITE failed, ret=%d\n",
469 ret);
470 return -EIO;
471 }
472 chunk_off += this_write;
473 xdr_off += this_write;
474 xfer_len -= this_write;
475 write_len -= this_write;
476 }
477 }
478
479 svc_rdma_xdr_encode_reply_array(res_ary, chunk_no);
480
481 return rqstp->rq_res.len;
482}
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499static int send_reply(struct svcxprt_rdma *rdma,
500 struct svc_rqst *rqstp,
501 struct page *page,
502 struct rpcrdma_msg *rdma_resp,
503 struct svc_rdma_op_ctxt *ctxt,
504 struct svc_rdma_req_map *vec,
505 int byte_count)
506{
507 struct ib_send_wr send_wr;
508 struct ib_send_wr inv_wr;
509 int sge_no;
510 int sge_bytes;
511 int page_no;
512 int ret;
513
514
515 ret = svc_rdma_post_recv(rdma);
516 if (ret) {
517 printk(KERN_INFO
518 "svcrdma: could not post a receive buffer, err=%d."
519 "Closing transport %p.\n", ret, rdma);
520 set_bit(XPT_CLOSE, &rdma->sc_xprt.xpt_flags);
521 svc_rdma_put_frmr(rdma, vec->frmr);
522 svc_rdma_put_context(ctxt, 0);
523 return -ENOTCONN;
524 }
525
526
527 ctxt->pages[0] = page;
528 ctxt->count = 1;
529 ctxt->frmr = vec->frmr;
530 if (vec->frmr)
531 set_bit(RDMACTXT_F_FAST_UNREG, &ctxt->flags);
532 else
533 clear_bit(RDMACTXT_F_FAST_UNREG, &ctxt->flags);
534
535
536 ctxt->sge[0].lkey = rdma->sc_dma_lkey;
537 ctxt->sge[0].length = svc_rdma_xdr_get_reply_hdr_len(rdma_resp);
538 ctxt->sge[0].addr =
539 ib_dma_map_single(rdma->sc_cm_id->device, page_address(page),
540 ctxt->sge[0].length, DMA_TO_DEVICE);
541 if (ib_dma_mapping_error(rdma->sc_cm_id->device, ctxt->sge[0].addr))
542 goto err;
543 atomic_inc(&rdma->sc_dma_used);
544
545 ctxt->direction = DMA_TO_DEVICE;
546
547
548 for (sge_no = 1; byte_count && sge_no < vec->count; sge_no++) {
549 sge_bytes = min_t(size_t, vec->sge[sge_no].iov_len, byte_count);
550 byte_count -= sge_bytes;
551 if (!vec->frmr) {
552 ctxt->sge[sge_no].addr =
553 ib_dma_map_single(rdma->sc_cm_id->device,
554 vec->sge[sge_no].iov_base,
555 sge_bytes, DMA_TO_DEVICE);
556 if (ib_dma_mapping_error(rdma->sc_cm_id->device,
557 ctxt->sge[sge_no].addr))
558 goto err;
559 atomic_inc(&rdma->sc_dma_used);
560 ctxt->sge[sge_no].lkey = rdma->sc_dma_lkey;
561 } else {
562 ctxt->sge[sge_no].addr = (unsigned long)
563 vec->sge[sge_no].iov_base;
564 ctxt->sge[sge_no].lkey = vec->frmr->mr->lkey;
565 }
566 ctxt->sge[sge_no].length = sge_bytes;
567 }
568 BUG_ON(byte_count != 0);
569
570
571
572
573
574 for (page_no = 0; page_no < rqstp->rq_resused; page_no++) {
575 ctxt->pages[page_no+1] = rqstp->rq_respages[page_no];
576 ctxt->count++;
577 rqstp->rq_respages[page_no] = NULL;
578
579
580
581
582
583 if (page_no+1 >= sge_no)
584 ctxt->sge[page_no+1].length = 0;
585 }
586 BUG_ON(sge_no > rdma->sc_max_sge);
587 memset(&send_wr, 0, sizeof send_wr);
588 ctxt->wr_op = IB_WR_SEND;
589 send_wr.wr_id = (unsigned long)ctxt;
590 send_wr.sg_list = ctxt->sge;
591 send_wr.num_sge = sge_no;
592 send_wr.opcode = IB_WR_SEND;
593 send_wr.send_flags = IB_SEND_SIGNALED;
594 if (vec->frmr) {
595
596 memset(&inv_wr, 0, sizeof inv_wr);
597 inv_wr.opcode = IB_WR_LOCAL_INV;
598 inv_wr.send_flags = IB_SEND_SIGNALED;
599 inv_wr.ex.invalidate_rkey =
600 vec->frmr->mr->lkey;
601 send_wr.next = &inv_wr;
602 }
603
604 ret = svc_rdma_send(rdma, &send_wr);
605 if (ret)
606 goto err;
607
608 return 0;
609
610 err:
611 svc_rdma_unmap_dma(ctxt);
612 svc_rdma_put_frmr(rdma, vec->frmr);
613 svc_rdma_put_context(ctxt, 1);
614 return -EIO;
615}
616
617void svc_rdma_prep_reply_hdr(struct svc_rqst *rqstp)
618{
619}
620
621
622
623
624static void *xdr_start(struct xdr_buf *xdr)
625{
626 return xdr->head[0].iov_base -
627 (xdr->len -
628 xdr->page_len -
629 xdr->tail[0].iov_len -
630 xdr->head[0].iov_len);
631}
632
633int svc_rdma_sendto(struct svc_rqst *rqstp)
634{
635 struct svc_xprt *xprt = rqstp->rq_xprt;
636 struct svcxprt_rdma *rdma =
637 container_of(xprt, struct svcxprt_rdma, sc_xprt);
638 struct rpcrdma_msg *rdma_argp;
639 struct rpcrdma_msg *rdma_resp;
640 struct rpcrdma_write_array *reply_ary;
641 enum rpcrdma_proc reply_type;
642 int ret;
643 int inline_bytes;
644 struct page *res_page;
645 struct svc_rdma_op_ctxt *ctxt;
646 struct svc_rdma_req_map *vec;
647
648 dprintk("svcrdma: sending response for rqstp=%p\n", rqstp);
649
650
651 rdma_argp = xdr_start(&rqstp->rq_arg);
652
653
654 ctxt = svc_rdma_get_context(rdma);
655 ctxt->direction = DMA_TO_DEVICE;
656 vec = svc_rdma_get_req_map();
657 ret = map_xdr(rdma, &rqstp->rq_res, vec);
658 if (ret)
659 goto err0;
660 inline_bytes = rqstp->rq_res.len;
661
662
663 res_page = svc_rdma_get_page();
664 rdma_resp = page_address(res_page);
665 reply_ary = svc_rdma_get_reply_array(rdma_argp);
666 if (reply_ary)
667 reply_type = RDMA_NOMSG;
668 else
669 reply_type = RDMA_MSG;
670 svc_rdma_xdr_encode_reply_header(rdma, rdma_argp,
671 rdma_resp, reply_type);
672
673
674 ret = send_write_chunks(rdma, rdma_argp, rdma_resp,
675 rqstp, vec);
676 if (ret < 0) {
677 printk(KERN_ERR "svcrdma: failed to send write chunks, rc=%d\n",
678 ret);
679 goto err1;
680 }
681 inline_bytes -= ret;
682
683
684 ret = send_reply_chunks(rdma, rdma_argp, rdma_resp,
685 rqstp, vec);
686 if (ret < 0) {
687 printk(KERN_ERR "svcrdma: failed to send reply chunks, rc=%d\n",
688 ret);
689 goto err1;
690 }
691 inline_bytes -= ret;
692
693 ret = send_reply(rdma, rqstp, res_page, rdma_resp, ctxt, vec,
694 inline_bytes);
695 svc_rdma_put_req_map(vec);
696 dprintk("svcrdma: send_reply returns %d\n", ret);
697 return ret;
698
699 err1:
700 put_page(res_page);
701 err0:
702 svc_rdma_put_req_map(vec);
703 svc_rdma_put_context(ctxt, 0);
704 return ret;
705}
706