svc_rdma_recvfrom.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693
  1. /*
  2. * Copyright (c) 2014 Open Grid Computing, Inc. All rights reserved.
  3. * Copyright (c) 2005-2006 Network Appliance, Inc. All rights reserved.
  4. *
  5. * This software is available to you under a choice of one of two
  6. * licenses. You may choose to be licensed under the terms of the GNU
  7. * General Public License (GPL) Version 2, available from the file
  8. * COPYING in the main directory of this source tree, or the BSD-type
  9. * license below:
  10. *
  11. * Redistribution and use in source and binary forms, with or without
  12. * modification, are permitted provided that the following conditions
  13. * are met:
  14. *
  15. * Redistributions of source code must retain the above copyright
  16. * notice, this list of conditions and the following disclaimer.
  17. *
  18. * Redistributions in binary form must reproduce the above
  19. * copyright notice, this list of conditions and the following
  20. * disclaimer in the documentation and/or other materials provided
  21. * with the distribution.
  22. *
  23. * Neither the name of the Network Appliance, Inc. nor the names of
  24. * its contributors may be used to endorse or promote products
  25. * derived from this software without specific prior written
  26. * permission.
  27. *
  28. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  29. * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  30. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  31. * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  32. * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  33. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  34. * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  35. * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  36. * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  37. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  38. * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  39. *
  40. * Author: Tom Tucker <tom@opengridcomputing.com>
  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. #define RPCDBG_FACILITY RPCDBG_SVCXPRT
  50. /*
  51. * Replace the pages in the rq_argpages array with the pages from the SGE in
  52. * the RDMA_RECV completion. The SGL should contain full pages up until the
  53. * last one.
  54. */
  55. static void rdma_build_arg_xdr(struct svc_rqst *rqstp,
  56. struct svc_rdma_op_ctxt *ctxt,
  57. u32 byte_count)
  58. {
  59. struct rpcrdma_msg *rmsgp;
  60. struct page *page;
  61. u32 bc;
  62. int sge_no;
  63. /* Swap the page in the SGE with the page in argpages */
  64. page = ctxt->pages[0];
  65. put_page(rqstp->rq_pages[0]);
  66. rqstp->rq_pages[0] = page;
  67. /* Set up the XDR head */
  68. rqstp->rq_arg.head[0].iov_base = page_address(page);
  69. rqstp->rq_arg.head[0].iov_len =
  70. min_t(size_t, byte_count, ctxt->sge[0].length);
  71. rqstp->rq_arg.len = byte_count;
  72. rqstp->rq_arg.buflen = byte_count;
  73. /* Compute bytes past head in the SGL */
  74. bc = byte_count - rqstp->rq_arg.head[0].iov_len;
  75. /* If data remains, store it in the pagelist */
  76. rqstp->rq_arg.page_len = bc;
  77. rqstp->rq_arg.page_base = 0;
  78. /* RDMA_NOMSG: RDMA READ data should land just after RDMA RECV data */
  79. rmsgp = (struct rpcrdma_msg *)rqstp->rq_arg.head[0].iov_base;
  80. if (rmsgp->rm_type == rdma_nomsg)
  81. rqstp->rq_arg.pages = &rqstp->rq_pages[0];
  82. else
  83. rqstp->rq_arg.pages = &rqstp->rq_pages[1];
  84. sge_no = 1;
  85. while (bc && sge_no < ctxt->count) {
  86. page = ctxt->pages[sge_no];
  87. put_page(rqstp->rq_pages[sge_no]);
  88. rqstp->rq_pages[sge_no] = page;
  89. bc -= min_t(u32, bc, ctxt->sge[sge_no].length);
  90. rqstp->rq_arg.buflen += ctxt->sge[sge_no].length;
  91. sge_no++;
  92. }
  93. rqstp->rq_respages = &rqstp->rq_pages[sge_no];
  94. rqstp->rq_next_page = rqstp->rq_respages + 1;
  95. /* If not all pages were used from the SGL, free the remaining ones */
  96. bc = sge_no;
  97. while (sge_no < ctxt->count) {
  98. page = ctxt->pages[sge_no++];
  99. put_page(page);
  100. }
  101. ctxt->count = bc;
  102. /* Set up tail */
  103. rqstp->rq_arg.tail[0].iov_base = NULL;
  104. rqstp->rq_arg.tail[0].iov_len = 0;
  105. }
  106. /* Issue an RDMA_READ using the local lkey to map the data sink */
  107. int rdma_read_chunk_lcl(struct svcxprt_rdma *xprt,
  108. struct svc_rqst *rqstp,
  109. struct svc_rdma_op_ctxt *head,
  110. int *page_no,
  111. u32 *page_offset,
  112. u32 rs_handle,
  113. u32 rs_length,
  114. u64 rs_offset,
  115. bool last)
  116. {
  117. struct ib_rdma_wr read_wr;
  118. int pages_needed = PAGE_ALIGN(*page_offset + rs_length) >> PAGE_SHIFT;
  119. struct svc_rdma_op_ctxt *ctxt = svc_rdma_get_context(xprt);
  120. int ret, read, pno;
  121. u32 pg_off = *page_offset;
  122. u32 pg_no = *page_no;
  123. ctxt->direction = DMA_FROM_DEVICE;
  124. ctxt->read_hdr = head;
  125. pages_needed = min_t(int, pages_needed, xprt->sc_max_sge_rd);
  126. read = min_t(int, (pages_needed << PAGE_SHIFT) - *page_offset,
  127. rs_length);
  128. for (pno = 0; pno < pages_needed; pno++) {
  129. int len = min_t(int, rs_length, PAGE_SIZE - pg_off);
  130. head->arg.pages[pg_no] = rqstp->rq_arg.pages[pg_no];
  131. head->arg.page_len += len;
  132. head->arg.len += len;
  133. if (!pg_off)
  134. head->count++;
  135. rqstp->rq_respages = &rqstp->rq_arg.pages[pg_no+1];
  136. rqstp->rq_next_page = rqstp->rq_respages + 1;
  137. ctxt->sge[pno].addr =
  138. ib_dma_map_page(xprt->sc_cm_id->device,
  139. head->arg.pages[pg_no], pg_off,
  140. PAGE_SIZE - pg_off,
  141. DMA_FROM_DEVICE);
  142. ret = ib_dma_mapping_error(xprt->sc_cm_id->device,
  143. ctxt->sge[pno].addr);
  144. if (ret)
  145. goto err;
  146. atomic_inc(&xprt->sc_dma_used);
  147. ctxt->sge[pno].lkey = xprt->sc_pd->local_dma_lkey;
  148. ctxt->sge[pno].length = len;
  149. ctxt->count++;
  150. /* adjust offset and wrap to next page if needed */
  151. pg_off += len;
  152. if (pg_off == PAGE_SIZE) {
  153. pg_off = 0;
  154. pg_no++;
  155. }
  156. rs_length -= len;
  157. }
  158. if (last && rs_length == 0)
  159. set_bit(RDMACTXT_F_LAST_CTXT, &ctxt->flags);
  160. else
  161. clear_bit(RDMACTXT_F_LAST_CTXT, &ctxt->flags);
  162. memset(&read_wr, 0, sizeof(read_wr));
  163. ctxt->cqe.done = svc_rdma_wc_read;
  164. read_wr.wr.wr_cqe = &ctxt->cqe;
  165. read_wr.wr.opcode = IB_WR_RDMA_READ;
  166. read_wr.wr.send_flags = IB_SEND_SIGNALED;
  167. read_wr.rkey = rs_handle;
  168. read_wr.remote_addr = rs_offset;
  169. read_wr.wr.sg_list = ctxt->sge;
  170. read_wr.wr.num_sge = pages_needed;
  171. ret = svc_rdma_send(xprt, &read_wr.wr);
  172. if (ret) {
  173. pr_err("svcrdma: Error %d posting RDMA_READ\n", ret);
  174. set_bit(XPT_CLOSE, &xprt->sc_xprt.xpt_flags);
  175. goto err;
  176. }
  177. /* return current location in page array */
  178. *page_no = pg_no;
  179. *page_offset = pg_off;
  180. ret = read;
  181. atomic_inc(&rdma_stat_read);
  182. return ret;
  183. err:
  184. svc_rdma_unmap_dma(ctxt);
  185. svc_rdma_put_context(ctxt, 0);
  186. return ret;
  187. }
  188. /* Issue an RDMA_READ using an FRMR to map the data sink */
  189. int rdma_read_chunk_frmr(struct svcxprt_rdma *xprt,
  190. struct svc_rqst *rqstp,
  191. struct svc_rdma_op_ctxt *head,
  192. int *page_no,
  193. u32 *page_offset,
  194. u32 rs_handle,
  195. u32 rs_length,
  196. u64 rs_offset,
  197. bool last)
  198. {
  199. struct ib_rdma_wr read_wr;
  200. struct ib_send_wr inv_wr;
  201. struct ib_reg_wr reg_wr;
  202. u8 key;
  203. int nents = PAGE_ALIGN(*page_offset + rs_length) >> PAGE_SHIFT;
  204. struct svc_rdma_op_ctxt *ctxt = svc_rdma_get_context(xprt);
  205. struct svc_rdma_fastreg_mr *frmr = svc_rdma_get_frmr(xprt);
  206. int ret, read, pno, dma_nents, n;
  207. u32 pg_off = *page_offset;
  208. u32 pg_no = *page_no;
  209. if (IS_ERR(frmr))
  210. return -ENOMEM;
  211. ctxt->direction = DMA_FROM_DEVICE;
  212. ctxt->frmr = frmr;
  213. nents = min_t(unsigned int, nents, xprt->sc_frmr_pg_list_len);
  214. read = min_t(int, (nents << PAGE_SHIFT) - *page_offset, rs_length);
  215. frmr->direction = DMA_FROM_DEVICE;
  216. frmr->access_flags = (IB_ACCESS_LOCAL_WRITE|IB_ACCESS_REMOTE_WRITE);
  217. frmr->sg_nents = nents;
  218. for (pno = 0; pno < nents; pno++) {
  219. int len = min_t(int, rs_length, PAGE_SIZE - pg_off);
  220. head->arg.pages[pg_no] = rqstp->rq_arg.pages[pg_no];
  221. head->arg.page_len += len;
  222. head->arg.len += len;
  223. if (!pg_off)
  224. head->count++;
  225. sg_set_page(&frmr->sg[pno], rqstp->rq_arg.pages[pg_no],
  226. len, pg_off);
  227. rqstp->rq_respages = &rqstp->rq_arg.pages[pg_no+1];
  228. rqstp->rq_next_page = rqstp->rq_respages + 1;
  229. /* adjust offset and wrap to next page if needed */
  230. pg_off += len;
  231. if (pg_off == PAGE_SIZE) {
  232. pg_off = 0;
  233. pg_no++;
  234. }
  235. rs_length -= len;
  236. }
  237. if (last && rs_length == 0)
  238. set_bit(RDMACTXT_F_LAST_CTXT, &ctxt->flags);
  239. else
  240. clear_bit(RDMACTXT_F_LAST_CTXT, &ctxt->flags);
  241. dma_nents = ib_dma_map_sg(xprt->sc_cm_id->device,
  242. frmr->sg, frmr->sg_nents,
  243. frmr->direction);
  244. if (!dma_nents) {
  245. pr_err("svcrdma: failed to dma map sg %p\n",
  246. frmr->sg);
  247. return -ENOMEM;
  248. }
  249. atomic_inc(&xprt->sc_dma_used);
  250. n = ib_map_mr_sg(frmr->mr, frmr->sg, frmr->sg_nents, NULL, PAGE_SIZE);
  251. if (unlikely(n != frmr->sg_nents)) {
  252. pr_err("svcrdma: failed to map mr %p (%d/%d elements)\n",
  253. frmr->mr, n, frmr->sg_nents);
  254. return n < 0 ? n : -EINVAL;
  255. }
  256. /* Bump the key */
  257. key = (u8)(frmr->mr->lkey & 0x000000FF);
  258. ib_update_fast_reg_key(frmr->mr, ++key);
  259. ctxt->sge[0].addr = frmr->mr->iova;
  260. ctxt->sge[0].lkey = frmr->mr->lkey;
  261. ctxt->sge[0].length = frmr->mr->length;
  262. ctxt->count = 1;
  263. ctxt->read_hdr = head;
  264. /* Prepare REG WR */
  265. ctxt->reg_cqe.done = svc_rdma_wc_reg;
  266. reg_wr.wr.wr_cqe = &ctxt->reg_cqe;
  267. reg_wr.wr.opcode = IB_WR_REG_MR;
  268. reg_wr.wr.send_flags = IB_SEND_SIGNALED;
  269. reg_wr.wr.num_sge = 0;
  270. reg_wr.mr = frmr->mr;
  271. reg_wr.key = frmr->mr->lkey;
  272. reg_wr.access = frmr->access_flags;
  273. reg_wr.wr.next = &read_wr.wr;
  274. /* Prepare RDMA_READ */
  275. memset(&read_wr, 0, sizeof(read_wr));
  276. ctxt->cqe.done = svc_rdma_wc_read;
  277. read_wr.wr.wr_cqe = &ctxt->cqe;
  278. read_wr.wr.send_flags = IB_SEND_SIGNALED;
  279. read_wr.rkey = rs_handle;
  280. read_wr.remote_addr = rs_offset;
  281. read_wr.wr.sg_list = ctxt->sge;
  282. read_wr.wr.num_sge = 1;
  283. if (xprt->sc_dev_caps & SVCRDMA_DEVCAP_READ_W_INV) {
  284. read_wr.wr.opcode = IB_WR_RDMA_READ_WITH_INV;
  285. read_wr.wr.ex.invalidate_rkey = ctxt->frmr->mr->lkey;
  286. } else {
  287. read_wr.wr.opcode = IB_WR_RDMA_READ;
  288. read_wr.wr.next = &inv_wr;
  289. /* Prepare invalidate */
  290. memset(&inv_wr, 0, sizeof(inv_wr));
  291. ctxt->inv_cqe.done = svc_rdma_wc_inv;
  292. inv_wr.wr_cqe = &ctxt->inv_cqe;
  293. inv_wr.opcode = IB_WR_LOCAL_INV;
  294. inv_wr.send_flags = IB_SEND_SIGNALED | IB_SEND_FENCE;
  295. inv_wr.ex.invalidate_rkey = frmr->mr->lkey;
  296. }
  297. /* Post the chain */
  298. ret = svc_rdma_send(xprt, &reg_wr.wr);
  299. if (ret) {
  300. pr_err("svcrdma: Error %d posting RDMA_READ\n", ret);
  301. set_bit(XPT_CLOSE, &xprt->sc_xprt.xpt_flags);
  302. goto err;
  303. }
  304. /* return current location in page array */
  305. *page_no = pg_no;
  306. *page_offset = pg_off;
  307. ret = read;
  308. atomic_inc(&rdma_stat_read);
  309. return ret;
  310. err:
  311. ib_dma_unmap_sg(xprt->sc_cm_id->device,
  312. frmr->sg, frmr->sg_nents, frmr->direction);
  313. svc_rdma_put_context(ctxt, 0);
  314. svc_rdma_put_frmr(xprt, frmr);
  315. return ret;
  316. }
  317. static unsigned int
  318. rdma_rcl_chunk_count(struct rpcrdma_read_chunk *ch)
  319. {
  320. unsigned int count;
  321. for (count = 0; ch->rc_discrim != xdr_zero; ch++)
  322. count++;
  323. return count;
  324. }
  325. /* If there was additional inline content, append it to the end of arg.pages.
  326. * Tail copy has to be done after the reader function has determined how many
  327. * pages are needed for RDMA READ.
  328. */
  329. static int
  330. rdma_copy_tail(struct svc_rqst *rqstp, struct svc_rdma_op_ctxt *head,
  331. u32 position, u32 byte_count, u32 page_offset, int page_no)
  332. {
  333. char *srcp, *destp;
  334. int ret;
  335. ret = 0;
  336. srcp = head->arg.head[0].iov_base + position;
  337. byte_count = head->arg.head[0].iov_len - position;
  338. if (byte_count > PAGE_SIZE) {
  339. dprintk("svcrdma: large tail unsupported\n");
  340. return 0;
  341. }
  342. /* Fit as much of the tail on the current page as possible */
  343. if (page_offset != PAGE_SIZE) {
  344. destp = page_address(rqstp->rq_arg.pages[page_no]);
  345. destp += page_offset;
  346. while (byte_count--) {
  347. *destp++ = *srcp++;
  348. page_offset++;
  349. if (page_offset == PAGE_SIZE && byte_count)
  350. goto more;
  351. }
  352. goto done;
  353. }
  354. more:
  355. /* Fit the rest on the next page */
  356. page_no++;
  357. destp = page_address(rqstp->rq_arg.pages[page_no]);
  358. while (byte_count--)
  359. *destp++ = *srcp++;
  360. rqstp->rq_respages = &rqstp->rq_arg.pages[page_no+1];
  361. rqstp->rq_next_page = rqstp->rq_respages + 1;
  362. done:
  363. byte_count = head->arg.head[0].iov_len - position;
  364. head->arg.page_len += byte_count;
  365. head->arg.len += byte_count;
  366. head->arg.buflen += byte_count;
  367. return 1;
  368. }
  369. static int rdma_read_chunks(struct svcxprt_rdma *xprt,
  370. struct rpcrdma_msg *rmsgp,
  371. struct svc_rqst *rqstp,
  372. struct svc_rdma_op_ctxt *head)
  373. {
  374. int page_no, ret;
  375. struct rpcrdma_read_chunk *ch;
  376. u32 handle, page_offset, byte_count;
  377. u32 position;
  378. u64 rs_offset;
  379. bool last;
  380. /* If no read list is present, return 0 */
  381. ch = svc_rdma_get_read_chunk(rmsgp);
  382. if (!ch)
  383. return 0;
  384. if (rdma_rcl_chunk_count(ch) > RPCSVC_MAXPAGES)
  385. return -EINVAL;
  386. /* The request is completed when the RDMA_READs complete. The
  387. * head context keeps all the pages that comprise the
  388. * request.
  389. */
  390. head->arg.head[0] = rqstp->rq_arg.head[0];
  391. head->arg.tail[0] = rqstp->rq_arg.tail[0];
  392. head->hdr_count = head->count;
  393. head->arg.page_base = 0;
  394. head->arg.page_len = 0;
  395. head->arg.len = rqstp->rq_arg.len;
  396. head->arg.buflen = rqstp->rq_arg.buflen;
  397. /* RDMA_NOMSG: RDMA READ data should land just after RDMA RECV data */
  398. position = be32_to_cpu(ch->rc_position);
  399. if (position == 0) {
  400. head->arg.pages = &head->pages[0];
  401. page_offset = head->byte_len;
  402. } else {
  403. head->arg.pages = &head->pages[head->count];
  404. page_offset = 0;
  405. }
  406. ret = 0;
  407. page_no = 0;
  408. for (; ch->rc_discrim != xdr_zero; ch++) {
  409. if (be32_to_cpu(ch->rc_position) != position)
  410. goto err;
  411. handle = be32_to_cpu(ch->rc_target.rs_handle),
  412. byte_count = be32_to_cpu(ch->rc_target.rs_length);
  413. xdr_decode_hyper((__be32 *)&ch->rc_target.rs_offset,
  414. &rs_offset);
  415. while (byte_count > 0) {
  416. last = (ch + 1)->rc_discrim == xdr_zero;
  417. ret = xprt->sc_reader(xprt, rqstp, head,
  418. &page_no, &page_offset,
  419. handle, byte_count,
  420. rs_offset, last);
  421. if (ret < 0)
  422. goto err;
  423. byte_count -= ret;
  424. rs_offset += ret;
  425. head->arg.buflen += ret;
  426. }
  427. }
  428. /* Read list may need XDR round-up (see RFC 5666, s. 3.7) */
  429. if (page_offset & 3) {
  430. u32 pad = 4 - (page_offset & 3);
  431. head->arg.tail[0].iov_len += pad;
  432. head->arg.len += pad;
  433. head->arg.buflen += pad;
  434. page_offset += pad;
  435. }
  436. ret = 1;
  437. if (position && position < head->arg.head[0].iov_len)
  438. ret = rdma_copy_tail(rqstp, head, position,
  439. byte_count, page_offset, page_no);
  440. head->arg.head[0].iov_len = position;
  441. head->position = position;
  442. err:
  443. /* Detach arg pages. svc_recv will replenish them */
  444. for (page_no = 0;
  445. &rqstp->rq_pages[page_no] < rqstp->rq_respages; page_no++)
  446. rqstp->rq_pages[page_no] = NULL;
  447. return ret;
  448. }
  449. static void rdma_read_complete(struct svc_rqst *rqstp,
  450. struct svc_rdma_op_ctxt *head)
  451. {
  452. int page_no;
  453. /* Copy RPC pages */
  454. for (page_no = 0; page_no < head->count; page_no++) {
  455. put_page(rqstp->rq_pages[page_no]);
  456. rqstp->rq_pages[page_no] = head->pages[page_no];
  457. }
  458. /* Adjustments made for RDMA_NOMSG type requests */
  459. if (head->position == 0) {
  460. if (head->arg.len <= head->sge[0].length) {
  461. head->arg.head[0].iov_len = head->arg.len -
  462. head->byte_len;
  463. head->arg.page_len = 0;
  464. } else {
  465. head->arg.head[0].iov_len = head->sge[0].length -
  466. head->byte_len;
  467. head->arg.page_len = head->arg.len -
  468. head->sge[0].length;
  469. }
  470. }
  471. /* Point rq_arg.pages past header */
  472. rqstp->rq_arg.pages = &rqstp->rq_pages[head->hdr_count];
  473. rqstp->rq_arg.page_len = head->arg.page_len;
  474. rqstp->rq_arg.page_base = head->arg.page_base;
  475. /* rq_respages starts after the last arg page */
  476. rqstp->rq_respages = &rqstp->rq_pages[page_no];
  477. rqstp->rq_next_page = rqstp->rq_respages + 1;
  478. /* Rebuild rq_arg head and tail. */
  479. rqstp->rq_arg.head[0] = head->arg.head[0];
  480. rqstp->rq_arg.tail[0] = head->arg.tail[0];
  481. rqstp->rq_arg.len = head->arg.len;
  482. rqstp->rq_arg.buflen = head->arg.buflen;
  483. }
  484. /* By convention, backchannel calls arrive via rdma_msg type
  485. * messages, and never populate the chunk lists. This makes
  486. * the RPC/RDMA header small and fixed in size, so it is
  487. * straightforward to check the RPC header's direction field.
  488. */
  489. static bool
  490. svc_rdma_is_backchannel_reply(struct svc_xprt *xprt, struct rpcrdma_msg *rmsgp)
  491. {
  492. __be32 *p = (__be32 *)rmsgp;
  493. if (!xprt->xpt_bc_xprt)
  494. return false;
  495. if (rmsgp->rm_type != rdma_msg)
  496. return false;
  497. if (rmsgp->rm_body.rm_chunks[0] != xdr_zero)
  498. return false;
  499. if (rmsgp->rm_body.rm_chunks[1] != xdr_zero)
  500. return false;
  501. if (rmsgp->rm_body.rm_chunks[2] != xdr_zero)
  502. return false;
  503. /* sanity */
  504. if (p[7] != rmsgp->rm_xid)
  505. return false;
  506. /* call direction */
  507. if (p[8] == cpu_to_be32(RPC_CALL))
  508. return false;
  509. return true;
  510. }
  511. /*
  512. * Set up the rqstp thread context to point to the RQ buffer. If
  513. * necessary, pull additional data from the client with an RDMA_READ
  514. * request.
  515. */
  516. int svc_rdma_recvfrom(struct svc_rqst *rqstp)
  517. {
  518. struct svc_xprt *xprt = rqstp->rq_xprt;
  519. struct svcxprt_rdma *rdma_xprt =
  520. container_of(xprt, struct svcxprt_rdma, sc_xprt);
  521. struct svc_rdma_op_ctxt *ctxt = NULL;
  522. struct rpcrdma_msg *rmsgp;
  523. int ret = 0;
  524. dprintk("svcrdma: rqstp=%p\n", rqstp);
  525. spin_lock_bh(&rdma_xprt->sc_rq_dto_lock);
  526. if (!list_empty(&rdma_xprt->sc_read_complete_q)) {
  527. ctxt = list_entry(rdma_xprt->sc_read_complete_q.next,
  528. struct svc_rdma_op_ctxt,
  529. dto_q);
  530. list_del_init(&ctxt->dto_q);
  531. spin_unlock_bh(&rdma_xprt->sc_rq_dto_lock);
  532. rdma_read_complete(rqstp, ctxt);
  533. goto complete;
  534. } else if (!list_empty(&rdma_xprt->sc_rq_dto_q)) {
  535. ctxt = list_entry(rdma_xprt->sc_rq_dto_q.next,
  536. struct svc_rdma_op_ctxt,
  537. dto_q);
  538. list_del_init(&ctxt->dto_q);
  539. } else {
  540. atomic_inc(&rdma_stat_rq_starve);
  541. clear_bit(XPT_DATA, &xprt->xpt_flags);
  542. ctxt = NULL;
  543. }
  544. spin_unlock_bh(&rdma_xprt->sc_rq_dto_lock);
  545. if (!ctxt) {
  546. /* This is the EAGAIN path. The svc_recv routine will
  547. * return -EAGAIN, the nfsd thread will go to call into
  548. * svc_recv again and we shouldn't be on the active
  549. * transport list
  550. */
  551. if (test_bit(XPT_CLOSE, &xprt->xpt_flags))
  552. goto defer;
  553. goto out;
  554. }
  555. dprintk("svcrdma: processing ctxt=%p on xprt=%p, rqstp=%p, status=%d\n",
  556. ctxt, rdma_xprt, rqstp, ctxt->wc_status);
  557. atomic_inc(&rdma_stat_recv);
  558. /* Build up the XDR from the receive buffers. */
  559. rdma_build_arg_xdr(rqstp, ctxt, ctxt->byte_len);
  560. /* Decode the RDMA header. */
  561. rmsgp = (struct rpcrdma_msg *)rqstp->rq_arg.head[0].iov_base;
  562. ret = svc_rdma_xdr_decode_req(&rqstp->rq_arg);
  563. if (ret < 0)
  564. goto out_err;
  565. if (ret == 0)
  566. goto out_drop;
  567. rqstp->rq_xprt_hlen = ret;
  568. if (svc_rdma_is_backchannel_reply(xprt, rmsgp)) {
  569. ret = svc_rdma_handle_bc_reply(xprt->xpt_bc_xprt, rmsgp,
  570. &rqstp->rq_arg);
  571. svc_rdma_put_context(ctxt, 0);
  572. if (ret)
  573. goto repost;
  574. return ret;
  575. }
  576. /* Read read-list data. */
  577. ret = rdma_read_chunks(rdma_xprt, rmsgp, rqstp, ctxt);
  578. if (ret > 0) {
  579. /* read-list posted, defer until data received from client. */
  580. goto defer;
  581. } else if (ret < 0) {
  582. /* Post of read-list failed, free context. */
  583. svc_rdma_put_context(ctxt, 1);
  584. return 0;
  585. }
  586. complete:
  587. ret = rqstp->rq_arg.head[0].iov_len
  588. + rqstp->rq_arg.page_len
  589. + rqstp->rq_arg.tail[0].iov_len;
  590. svc_rdma_put_context(ctxt, 0);
  591. out:
  592. dprintk("svcrdma: ret=%d, rq_arg.len=%u, "
  593. "rq_arg.head[0].iov_base=%p, rq_arg.head[0].iov_len=%zd\n",
  594. ret, rqstp->rq_arg.len,
  595. rqstp->rq_arg.head[0].iov_base,
  596. rqstp->rq_arg.head[0].iov_len);
  597. rqstp->rq_prot = IPPROTO_MAX;
  598. svc_xprt_copy_addrs(rqstp, xprt);
  599. return ret;
  600. out_err:
  601. svc_rdma_send_error(rdma_xprt, rmsgp, ret);
  602. svc_rdma_put_context(ctxt, 0);
  603. return 0;
  604. defer:
  605. return 0;
  606. out_drop:
  607. svc_rdma_put_context(ctxt, 1);
  608. repost:
  609. return svc_rdma_repost_recv(rdma_xprt, GFP_KERNEL);
  610. }