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
43#include <linux/sunrpc/debug.h>
44#include <linux/sunrpc/rpc_rdma.h>
45#include <linux/spinlock.h>
46#include <asm/unaligned.h>
47#include <rdma/ib_verbs.h>
48#include <rdma/rdma_cm.h>
49#include <linux/sunrpc/svc_rdma.h>
50
51#define RPCDBG_FACILITY RPCDBG_SVCXPRT
52
53
54
55
56
57
58static void rdma_build_arg_xdr(struct svc_rqst *rqstp,
59 struct svc_rdma_op_ctxt *ctxt,
60 u32 byte_count)
61{
62 struct rpcrdma_msg *rmsgp;
63 struct page *page;
64 u32 bc;
65 int sge_no;
66
67
68 page = ctxt->pages[0];
69 put_page(rqstp->rq_pages[0]);
70 rqstp->rq_pages[0] = page;
71
72
73 rqstp->rq_arg.head[0].iov_base = page_address(page);
74 rqstp->rq_arg.head[0].iov_len =
75 min_t(size_t, byte_count, ctxt->sge[0].length);
76 rqstp->rq_arg.len = byte_count;
77 rqstp->rq_arg.buflen = byte_count;
78
79
80 bc = byte_count - rqstp->rq_arg.head[0].iov_len;
81
82
83 rqstp->rq_arg.page_len = bc;
84 rqstp->rq_arg.page_base = 0;
85
86
87 rmsgp = (struct rpcrdma_msg *)rqstp->rq_arg.head[0].iov_base;
88 if (rmsgp->rm_type == rdma_nomsg)
89 rqstp->rq_arg.pages = &rqstp->rq_pages[0];
90 else
91 rqstp->rq_arg.pages = &rqstp->rq_pages[1];
92
93 sge_no = 1;
94 while (bc && sge_no < ctxt->count) {
95 page = ctxt->pages[sge_no];
96 put_page(rqstp->rq_pages[sge_no]);
97 rqstp->rq_pages[sge_no] = page;
98 bc -= min_t(u32, bc, ctxt->sge[sge_no].length);
99 rqstp->rq_arg.buflen += ctxt->sge[sge_no].length;
100 sge_no++;
101 }
102 rqstp->rq_respages = &rqstp->rq_pages[sge_no];
103 rqstp->rq_next_page = rqstp->rq_respages + 1;
104
105
106 bc = sge_no;
107 while (sge_no < ctxt->count) {
108 page = ctxt->pages[sge_no++];
109 put_page(page);
110 }
111 ctxt->count = bc;
112
113
114 rqstp->rq_arg.tail[0].iov_base = NULL;
115 rqstp->rq_arg.tail[0].iov_len = 0;
116}
117
118
119int rdma_read_chunk_lcl(struct svcxprt_rdma *xprt,
120 struct svc_rqst *rqstp,
121 struct svc_rdma_op_ctxt *head,
122 int *page_no,
123 u32 *page_offset,
124 u32 rs_handle,
125 u32 rs_length,
126 u64 rs_offset,
127 bool last)
128{
129 struct ib_rdma_wr read_wr;
130 int pages_needed = PAGE_ALIGN(*page_offset + rs_length) >> PAGE_SHIFT;
131 struct svc_rdma_op_ctxt *ctxt = svc_rdma_get_context(xprt);
132 int ret, read, pno;
133 u32 pg_off = *page_offset;
134 u32 pg_no = *page_no;
135
136 ctxt->direction = DMA_FROM_DEVICE;
137 ctxt->read_hdr = head;
138 pages_needed = min_t(int, pages_needed, xprt->sc_max_sge_rd);
139 read = min_t(int, (pages_needed << PAGE_SHIFT) - *page_offset,
140 rs_length);
141
142 for (pno = 0; pno < pages_needed; pno++) {
143 int len = min_t(int, rs_length, PAGE_SIZE - pg_off);
144
145 head->arg.pages[pg_no] = rqstp->rq_arg.pages[pg_no];
146 head->arg.page_len += len;
147
148 head->arg.len += len;
149 if (!pg_off)
150 head->count++;
151 rqstp->rq_respages = &rqstp->rq_arg.pages[pg_no+1];
152 rqstp->rq_next_page = rqstp->rq_respages + 1;
153 ctxt->sge[pno].addr =
154 ib_dma_map_page(xprt->sc_cm_id->device,
155 head->arg.pages[pg_no], pg_off,
156 PAGE_SIZE - pg_off,
157 DMA_FROM_DEVICE);
158 ret = ib_dma_mapping_error(xprt->sc_cm_id->device,
159 ctxt->sge[pno].addr);
160 if (ret)
161 goto err;
162 svc_rdma_count_mappings(xprt, ctxt);
163
164 ctxt->sge[pno].lkey = xprt->sc_pd->local_dma_lkey;
165 ctxt->sge[pno].length = len;
166 ctxt->count++;
167
168
169 pg_off += len;
170 if (pg_off == PAGE_SIZE) {
171 pg_off = 0;
172 pg_no++;
173 }
174 rs_length -= len;
175 }
176
177 if (last && rs_length == 0)
178 set_bit(RDMACTXT_F_LAST_CTXT, &ctxt->flags);
179 else
180 clear_bit(RDMACTXT_F_LAST_CTXT, &ctxt->flags);
181
182 memset(&read_wr, 0, sizeof(read_wr));
183 ctxt->cqe.done = svc_rdma_wc_read;
184 read_wr.wr.wr_cqe = &ctxt->cqe;
185 read_wr.wr.opcode = IB_WR_RDMA_READ;
186 read_wr.wr.send_flags = IB_SEND_SIGNALED;
187 read_wr.rkey = rs_handle;
188 read_wr.remote_addr = rs_offset;
189 read_wr.wr.sg_list = ctxt->sge;
190 read_wr.wr.num_sge = pages_needed;
191
192 ret = svc_rdma_send(xprt, &read_wr.wr);
193 if (ret) {
194 pr_err("svcrdma: Error %d posting RDMA_READ\n", ret);
195 set_bit(XPT_CLOSE, &xprt->sc_xprt.xpt_flags);
196 goto err;
197 }
198
199
200 *page_no = pg_no;
201 *page_offset = pg_off;
202 ret = read;
203 atomic_inc(&rdma_stat_read);
204 return ret;
205 err:
206 svc_rdma_unmap_dma(ctxt);
207 svc_rdma_put_context(ctxt, 0);
208 return ret;
209}
210
211
212int rdma_read_chunk_frmr(struct svcxprt_rdma *xprt,
213 struct svc_rqst *rqstp,
214 struct svc_rdma_op_ctxt *head,
215 int *page_no,
216 u32 *page_offset,
217 u32 rs_handle,
218 u32 rs_length,
219 u64 rs_offset,
220 bool last)
221{
222 struct ib_rdma_wr read_wr;
223 struct ib_send_wr inv_wr;
224 struct ib_reg_wr reg_wr;
225 u8 key;
226 int nents = PAGE_ALIGN(*page_offset + rs_length) >> PAGE_SHIFT;
227 struct svc_rdma_op_ctxt *ctxt = svc_rdma_get_context(xprt);
228 struct svc_rdma_fastreg_mr *frmr = svc_rdma_get_frmr(xprt);
229 int ret, read, pno, dma_nents, n;
230 u32 pg_off = *page_offset;
231 u32 pg_no = *page_no;
232
233 if (IS_ERR(frmr))
234 return -ENOMEM;
235
236 ctxt->direction = DMA_FROM_DEVICE;
237 ctxt->frmr = frmr;
238 nents = min_t(unsigned int, nents, xprt->sc_frmr_pg_list_len);
239 read = min_t(int, (nents << PAGE_SHIFT) - *page_offset, rs_length);
240
241 frmr->direction = DMA_FROM_DEVICE;
242 frmr->access_flags = (IB_ACCESS_LOCAL_WRITE|IB_ACCESS_REMOTE_WRITE);
243 frmr->sg_nents = nents;
244
245 for (pno = 0; pno < nents; pno++) {
246 int len = min_t(int, rs_length, PAGE_SIZE - pg_off);
247
248 head->arg.pages[pg_no] = rqstp->rq_arg.pages[pg_no];
249 head->arg.page_len += len;
250 head->arg.len += len;
251 if (!pg_off)
252 head->count++;
253
254 sg_set_page(&frmr->sg[pno], rqstp->rq_arg.pages[pg_no],
255 len, pg_off);
256
257 rqstp->rq_respages = &rqstp->rq_arg.pages[pg_no+1];
258 rqstp->rq_next_page = rqstp->rq_respages + 1;
259
260
261 pg_off += len;
262 if (pg_off == PAGE_SIZE) {
263 pg_off = 0;
264 pg_no++;
265 }
266 rs_length -= len;
267 }
268
269 if (last && rs_length == 0)
270 set_bit(RDMACTXT_F_LAST_CTXT, &ctxt->flags);
271 else
272 clear_bit(RDMACTXT_F_LAST_CTXT, &ctxt->flags);
273
274 dma_nents = ib_dma_map_sg(xprt->sc_cm_id->device,
275 frmr->sg, frmr->sg_nents,
276 frmr->direction);
277 if (!dma_nents) {
278 pr_err("svcrdma: failed to dma map sg %p\n",
279 frmr->sg);
280 return -ENOMEM;
281 }
282 atomic_inc(&xprt->sc_dma_used);
283
284 n = ib_map_mr_sg(frmr->mr, frmr->sg, frmr->sg_nents, NULL, PAGE_SIZE);
285 if (unlikely(n != frmr->sg_nents)) {
286 pr_err("svcrdma: failed to map mr %p (%d/%d elements)\n",
287 frmr->mr, n, frmr->sg_nents);
288 return n < 0 ? n : -EINVAL;
289 }
290
291
292 key = (u8)(frmr->mr->lkey & 0x000000FF);
293 ib_update_fast_reg_key(frmr->mr, ++key);
294
295 ctxt->sge[0].addr = frmr->mr->iova;
296 ctxt->sge[0].lkey = frmr->mr->lkey;
297 ctxt->sge[0].length = frmr->mr->length;
298 ctxt->count = 1;
299 ctxt->read_hdr = head;
300
301
302 ctxt->reg_cqe.done = svc_rdma_wc_reg;
303 reg_wr.wr.wr_cqe = &ctxt->reg_cqe;
304 reg_wr.wr.opcode = IB_WR_REG_MR;
305 reg_wr.wr.send_flags = IB_SEND_SIGNALED;
306 reg_wr.wr.num_sge = 0;
307 reg_wr.mr = frmr->mr;
308 reg_wr.key = frmr->mr->lkey;
309 reg_wr.access = frmr->access_flags;
310 reg_wr.wr.next = &read_wr.wr;
311
312
313 memset(&read_wr, 0, sizeof(read_wr));
314 ctxt->cqe.done = svc_rdma_wc_read;
315 read_wr.wr.wr_cqe = &ctxt->cqe;
316 read_wr.wr.send_flags = IB_SEND_SIGNALED;
317 read_wr.rkey = rs_handle;
318 read_wr.remote_addr = rs_offset;
319 read_wr.wr.sg_list = ctxt->sge;
320 read_wr.wr.num_sge = 1;
321 if (xprt->sc_dev_caps & SVCRDMA_DEVCAP_READ_W_INV) {
322 read_wr.wr.opcode = IB_WR_RDMA_READ_WITH_INV;
323 read_wr.wr.ex.invalidate_rkey = ctxt->frmr->mr->lkey;
324 } else {
325 read_wr.wr.opcode = IB_WR_RDMA_READ;
326 read_wr.wr.next = &inv_wr;
327
328 memset(&inv_wr, 0, sizeof(inv_wr));
329 ctxt->inv_cqe.done = svc_rdma_wc_inv;
330 inv_wr.wr_cqe = &ctxt->inv_cqe;
331 inv_wr.opcode = IB_WR_LOCAL_INV;
332 inv_wr.send_flags = IB_SEND_SIGNALED | IB_SEND_FENCE;
333 inv_wr.ex.invalidate_rkey = frmr->mr->lkey;
334 }
335
336
337 ret = svc_rdma_send(xprt, ®_wr.wr);
338 if (ret) {
339 pr_err("svcrdma: Error %d posting RDMA_READ\n", ret);
340 set_bit(XPT_CLOSE, &xprt->sc_xprt.xpt_flags);
341 goto err;
342 }
343
344
345 *page_no = pg_no;
346 *page_offset = pg_off;
347 ret = read;
348 atomic_inc(&rdma_stat_read);
349 return ret;
350 err:
351 ib_dma_unmap_sg(xprt->sc_cm_id->device,
352 frmr->sg, frmr->sg_nents, frmr->direction);
353 svc_rdma_put_context(ctxt, 0);
354 svc_rdma_put_frmr(xprt, frmr);
355 return ret;
356}
357
358static unsigned int
359rdma_rcl_chunk_count(struct rpcrdma_read_chunk *ch)
360{
361 unsigned int count;
362
363 for (count = 0; ch->rc_discrim != xdr_zero; ch++)
364 count++;
365 return count;
366}
367
368
369
370
371
372static int
373rdma_copy_tail(struct svc_rqst *rqstp, struct svc_rdma_op_ctxt *head,
374 u32 position, u32 byte_count, u32 page_offset, int page_no)
375{
376 char *srcp, *destp;
377 int ret;
378
379 ret = 0;
380 srcp = head->arg.head[0].iov_base + position;
381 byte_count = head->arg.head[0].iov_len - position;
382 if (byte_count > PAGE_SIZE) {
383 dprintk("svcrdma: large tail unsupported\n");
384 return 0;
385 }
386
387
388 if (page_offset != PAGE_SIZE) {
389 destp = page_address(rqstp->rq_arg.pages[page_no]);
390 destp += page_offset;
391 while (byte_count--) {
392 *destp++ = *srcp++;
393 page_offset++;
394 if (page_offset == PAGE_SIZE && byte_count)
395 goto more;
396 }
397 goto done;
398 }
399
400more:
401
402 page_no++;
403 destp = page_address(rqstp->rq_arg.pages[page_no]);
404 while (byte_count--)
405 *destp++ = *srcp++;
406
407 rqstp->rq_respages = &rqstp->rq_arg.pages[page_no+1];
408 rqstp->rq_next_page = rqstp->rq_respages + 1;
409
410done:
411 byte_count = head->arg.head[0].iov_len - position;
412 head->arg.page_len += byte_count;
413 head->arg.len += byte_count;
414 head->arg.buflen += byte_count;
415 return 1;
416}
417
418static int rdma_read_chunks(struct svcxprt_rdma *xprt,
419 struct rpcrdma_msg *rmsgp,
420 struct svc_rqst *rqstp,
421 struct svc_rdma_op_ctxt *head)
422{
423 int page_no, ret;
424 struct rpcrdma_read_chunk *ch;
425 u32 handle, page_offset, byte_count;
426 u32 position;
427 u64 rs_offset;
428 bool last;
429
430
431 ch = svc_rdma_get_read_chunk(rmsgp);
432 if (!ch)
433 return 0;
434
435 if (rdma_rcl_chunk_count(ch) > RPCSVC_MAXPAGES)
436 return -EINVAL;
437
438
439
440
441
442 head->arg.head[0] = rqstp->rq_arg.head[0];
443 head->arg.tail[0] = rqstp->rq_arg.tail[0];
444 head->hdr_count = head->count;
445 head->arg.page_base = 0;
446 head->arg.page_len = 0;
447 head->arg.len = rqstp->rq_arg.len;
448 head->arg.buflen = rqstp->rq_arg.buflen;
449
450
451 position = be32_to_cpu(ch->rc_position);
452 if (position == 0) {
453 head->arg.pages = &head->pages[0];
454 page_offset = head->byte_len;
455 } else {
456 head->arg.pages = &head->pages[head->count];
457 page_offset = 0;
458 }
459
460 ret = 0;
461 page_no = 0;
462 for (; ch->rc_discrim != xdr_zero; ch++) {
463 if (be32_to_cpu(ch->rc_position) != position)
464 goto err;
465
466 handle = be32_to_cpu(ch->rc_target.rs_handle),
467 byte_count = be32_to_cpu(ch->rc_target.rs_length);
468 xdr_decode_hyper((__be32 *)&ch->rc_target.rs_offset,
469 &rs_offset);
470
471 while (byte_count > 0) {
472 last = (ch + 1)->rc_discrim == xdr_zero;
473 ret = xprt->sc_reader(xprt, rqstp, head,
474 &page_no, &page_offset,
475 handle, byte_count,
476 rs_offset, last);
477 if (ret < 0)
478 goto err;
479 byte_count -= ret;
480 rs_offset += ret;
481 head->arg.buflen += ret;
482 }
483 }
484
485
486 if (page_offset & 3) {
487 u32 pad = 4 - (page_offset & 3);
488
489 head->arg.tail[0].iov_len += pad;
490 head->arg.len += pad;
491 head->arg.buflen += pad;
492 page_offset += pad;
493 }
494
495 ret = 1;
496 if (position && position < head->arg.head[0].iov_len)
497 ret = rdma_copy_tail(rqstp, head, position,
498 byte_count, page_offset, page_no);
499 head->arg.head[0].iov_len = position;
500 head->position = position;
501
502 err:
503
504 for (page_no = 0;
505 &rqstp->rq_pages[page_no] < rqstp->rq_respages; page_no++)
506 rqstp->rq_pages[page_no] = NULL;
507
508 return ret;
509}
510
511static void rdma_read_complete(struct svc_rqst *rqstp,
512 struct svc_rdma_op_ctxt *head)
513{
514 int page_no;
515
516
517 for (page_no = 0; page_no < head->count; page_no++) {
518 put_page(rqstp->rq_pages[page_no]);
519 rqstp->rq_pages[page_no] = head->pages[page_no];
520 }
521
522
523 if (head->position == 0) {
524 if (head->arg.len <= head->sge[0].length) {
525 head->arg.head[0].iov_len = head->arg.len -
526 head->byte_len;
527 head->arg.page_len = 0;
528 } else {
529 head->arg.head[0].iov_len = head->sge[0].length -
530 head->byte_len;
531 head->arg.page_len = head->arg.len -
532 head->sge[0].length;
533 }
534 }
535
536
537 rqstp->rq_arg.pages = &rqstp->rq_pages[head->hdr_count];
538 rqstp->rq_arg.page_len = head->arg.page_len;
539 rqstp->rq_arg.page_base = head->arg.page_base;
540
541
542 rqstp->rq_respages = &rqstp->rq_pages[page_no];
543 rqstp->rq_next_page = rqstp->rq_respages + 1;
544
545
546 rqstp->rq_arg.head[0] = head->arg.head[0];
547 rqstp->rq_arg.tail[0] = head->arg.tail[0];
548 rqstp->rq_arg.len = head->arg.len;
549 rqstp->rq_arg.buflen = head->arg.buflen;
550}
551
552
553
554
555
556
557static bool
558svc_rdma_is_backchannel_reply(struct svc_xprt *xprt, struct rpcrdma_msg *rmsgp)
559{
560 __be32 *p = (__be32 *)rmsgp;
561
562 if (!xprt->xpt_bc_xprt)
563 return false;
564
565 if (rmsgp->rm_type != rdma_msg)
566 return false;
567 if (rmsgp->rm_body.rm_chunks[0] != xdr_zero)
568 return false;
569 if (rmsgp->rm_body.rm_chunks[1] != xdr_zero)
570 return false;
571 if (rmsgp->rm_body.rm_chunks[2] != xdr_zero)
572 return false;
573
574
575 if (p[7] != rmsgp->rm_xid)
576 return false;
577
578 if (p[8] == cpu_to_be32(RPC_CALL))
579 return false;
580
581 return true;
582}
583
584
585
586
587
588
589int svc_rdma_recvfrom(struct svc_rqst *rqstp)
590{
591 struct svc_xprt *xprt = rqstp->rq_xprt;
592 struct svcxprt_rdma *rdma_xprt =
593 container_of(xprt, struct svcxprt_rdma, sc_xprt);
594 struct svc_rdma_op_ctxt *ctxt = NULL;
595 struct rpcrdma_msg *rmsgp;
596 int ret = 0;
597
598 dprintk("svcrdma: rqstp=%p\n", rqstp);
599
600 spin_lock_bh(&rdma_xprt->sc_rq_dto_lock);
601 if (!list_empty(&rdma_xprt->sc_read_complete_q)) {
602 ctxt = list_entry(rdma_xprt->sc_read_complete_q.next,
603 struct svc_rdma_op_ctxt,
604 dto_q);
605 list_del_init(&ctxt->dto_q);
606 spin_unlock_bh(&rdma_xprt->sc_rq_dto_lock);
607 rdma_read_complete(rqstp, ctxt);
608 goto complete;
609 } else if (!list_empty(&rdma_xprt->sc_rq_dto_q)) {
610 ctxt = list_entry(rdma_xprt->sc_rq_dto_q.next,
611 struct svc_rdma_op_ctxt,
612 dto_q);
613 list_del_init(&ctxt->dto_q);
614 } else {
615 atomic_inc(&rdma_stat_rq_starve);
616 clear_bit(XPT_DATA, &xprt->xpt_flags);
617 ctxt = NULL;
618 }
619 spin_unlock_bh(&rdma_xprt->sc_rq_dto_lock);
620 if (!ctxt) {
621
622
623
624
625
626 if (test_bit(XPT_CLOSE, &xprt->xpt_flags))
627 goto defer;
628 goto out;
629 }
630 dprintk("svcrdma: processing ctxt=%p on xprt=%p, rqstp=%p, status=%d\n",
631 ctxt, rdma_xprt, rqstp, ctxt->wc_status);
632 atomic_inc(&rdma_stat_recv);
633
634
635 rdma_build_arg_xdr(rqstp, ctxt, ctxt->byte_len);
636
637
638 rmsgp = (struct rpcrdma_msg *)rqstp->rq_arg.head[0].iov_base;
639 ret = svc_rdma_xdr_decode_req(&rqstp->rq_arg);
640 if (ret < 0)
641 goto out_err;
642 if (ret == 0)
643 goto out_drop;
644 rqstp->rq_xprt_hlen = ret;
645
646 if (svc_rdma_is_backchannel_reply(xprt, rmsgp)) {
647 ret = svc_rdma_handle_bc_reply(xprt->xpt_bc_xprt, rmsgp,
648 &rqstp->rq_arg);
649 svc_rdma_put_context(ctxt, 0);
650 if (ret)
651 goto repost;
652 return ret;
653 }
654
655
656 ret = rdma_read_chunks(rdma_xprt, rmsgp, rqstp, ctxt);
657 if (ret > 0) {
658
659 goto defer;
660 } else if (ret < 0) {
661
662 svc_rdma_put_context(ctxt, 1);
663 return 0;
664 }
665
666complete:
667 ret = rqstp->rq_arg.head[0].iov_len
668 + rqstp->rq_arg.page_len
669 + rqstp->rq_arg.tail[0].iov_len;
670 svc_rdma_put_context(ctxt, 0);
671 out:
672 dprintk("svcrdma: ret=%d, rq_arg.len=%u, "
673 "rq_arg.head[0].iov_base=%p, rq_arg.head[0].iov_len=%zd\n",
674 ret, rqstp->rq_arg.len,
675 rqstp->rq_arg.head[0].iov_base,
676 rqstp->rq_arg.head[0].iov_len);
677 rqstp->rq_prot = IPPROTO_MAX;
678 svc_xprt_copy_addrs(rqstp, xprt);
679 return ret;
680
681out_err:
682 svc_rdma_send_error(rdma_xprt, rmsgp, ret);
683 svc_rdma_put_context(ctxt, 0);
684 return 0;
685
686defer:
687 return 0;
688
689out_drop:
690 svc_rdma_put_context(ctxt, 1);
691repost:
692 return svc_rdma_repost_recv(rdma_xprt, GFP_KERNEL);
693}
694