| // SPDX-License-Identifier: GPL-2.0 | 
| /* | 
|  * Copyright (c) 2016-2018 Oracle.  All rights reserved. | 
|  * | 
|  * Use the core R/W API to move RPC-over-RDMA Read and Write chunks. | 
|  */ | 
|   | 
| #include <rdma/rw.h> | 
|   | 
| #include <linux/sunrpc/xdr.h> | 
| #include <linux/sunrpc/rpc_rdma.h> | 
| #include <linux/sunrpc/svc_rdma.h> | 
|   | 
| #include "xprt_rdma.h" | 
| #include <trace/events/rpcrdma.h> | 
|   | 
| static void svc_rdma_write_done(struct ib_cq *cq, struct ib_wc *wc); | 
| static void svc_rdma_wc_read_done(struct ib_cq *cq, struct ib_wc *wc); | 
|   | 
| /* Each R/W context contains state for one chain of RDMA Read or | 
|  * Write Work Requests. | 
|  * | 
|  * Each WR chain handles a single contiguous server-side buffer, | 
|  * because scatterlist entries after the first have to start on | 
|  * page alignment. xdr_buf iovecs cannot guarantee alignment. | 
|  * | 
|  * Each WR chain handles only one R_key. Each RPC-over-RDMA segment | 
|  * from a client may contain a unique R_key, so each WR chain moves | 
|  * up to one segment at a time. | 
|  * | 
|  * The scatterlist makes this data structure over 4KB in size. To | 
|  * make it less likely to fail, and to handle the allocation for | 
|  * smaller I/O requests without disabling bottom-halves, these | 
|  * contexts are created on demand, but cached and reused until the | 
|  * controlling svcxprt_rdma is destroyed. | 
|  */ | 
| struct svc_rdma_rw_ctxt { | 
|     struct list_head    rw_list; | 
|     struct rdma_rw_ctx    rw_ctx; | 
|     unsigned int        rw_nents; | 
|     struct sg_table        rw_sg_table; | 
|     struct scatterlist    rw_first_sgl[]; | 
| }; | 
|   | 
| static inline struct svc_rdma_rw_ctxt * | 
| svc_rdma_next_ctxt(struct list_head *list) | 
| { | 
|     return list_first_entry_or_null(list, struct svc_rdma_rw_ctxt, | 
|                     rw_list); | 
| } | 
|   | 
| static struct svc_rdma_rw_ctxt * | 
| svc_rdma_get_rw_ctxt(struct svcxprt_rdma *rdma, unsigned int sges) | 
| { | 
|     struct svc_rdma_rw_ctxt *ctxt; | 
|   | 
|     spin_lock(&rdma->sc_rw_ctxt_lock); | 
|   | 
|     ctxt = svc_rdma_next_ctxt(&rdma->sc_rw_ctxts); | 
|     if (ctxt) { | 
|         list_del(&ctxt->rw_list); | 
|         spin_unlock(&rdma->sc_rw_ctxt_lock); | 
|     } else { | 
|         spin_unlock(&rdma->sc_rw_ctxt_lock); | 
|         ctxt = kmalloc(struct_size(ctxt, rw_first_sgl, SG_CHUNK_SIZE), | 
|                    GFP_KERNEL); | 
|         if (!ctxt) | 
|             goto out_noctx; | 
|         INIT_LIST_HEAD(&ctxt->rw_list); | 
|     } | 
|   | 
|     ctxt->rw_sg_table.sgl = ctxt->rw_first_sgl; | 
|     if (sg_alloc_table_chained(&ctxt->rw_sg_table, sges, | 
|                    ctxt->rw_sg_table.sgl, | 
|                    SG_CHUNK_SIZE)) | 
|         goto out_free; | 
|     return ctxt; | 
|   | 
| out_free: | 
|     kfree(ctxt); | 
| out_noctx: | 
|     trace_svcrdma_no_rwctx_err(rdma, sges); | 
|     return NULL; | 
| } | 
|   | 
| static void svc_rdma_put_rw_ctxt(struct svcxprt_rdma *rdma, | 
|                  struct svc_rdma_rw_ctxt *ctxt) | 
| { | 
|     sg_free_table_chained(&ctxt->rw_sg_table, SG_CHUNK_SIZE); | 
|   | 
|     spin_lock(&rdma->sc_rw_ctxt_lock); | 
|     list_add(&ctxt->rw_list, &rdma->sc_rw_ctxts); | 
|     spin_unlock(&rdma->sc_rw_ctxt_lock); | 
| } | 
|   | 
| /** | 
|  * svc_rdma_destroy_rw_ctxts - Free accumulated R/W contexts | 
|  * @rdma: transport about to be destroyed | 
|  * | 
|  */ | 
| void svc_rdma_destroy_rw_ctxts(struct svcxprt_rdma *rdma) | 
| { | 
|     struct svc_rdma_rw_ctxt *ctxt; | 
|   | 
|     while ((ctxt = svc_rdma_next_ctxt(&rdma->sc_rw_ctxts)) != NULL) { | 
|         list_del(&ctxt->rw_list); | 
|         kfree(ctxt); | 
|     } | 
| } | 
|   | 
| /** | 
|  * svc_rdma_rw_ctx_init - Prepare a R/W context for I/O | 
|  * @rdma: controlling transport instance | 
|  * @ctxt: R/W context to prepare | 
|  * @offset: RDMA offset | 
|  * @handle: RDMA tag/handle | 
|  * @direction: I/O direction | 
|  * | 
|  * Returns on success, the number of WQEs that will be needed | 
|  * on the workqueue, or a negative errno. | 
|  */ | 
| static int svc_rdma_rw_ctx_init(struct svcxprt_rdma *rdma, | 
|                 struct svc_rdma_rw_ctxt *ctxt, | 
|                 u64 offset, u32 handle, | 
|                 enum dma_data_direction direction) | 
| { | 
|     int ret; | 
|   | 
|     ret = rdma_rw_ctx_init(&ctxt->rw_ctx, rdma->sc_qp, rdma->sc_port_num, | 
|                    ctxt->rw_sg_table.sgl, ctxt->rw_nents, | 
|                    0, offset, handle, direction); | 
|     if (unlikely(ret < 0)) { | 
|         svc_rdma_put_rw_ctxt(rdma, ctxt); | 
|         trace_svcrdma_dma_map_rw_err(rdma, ctxt->rw_nents, ret); | 
|     } | 
|     return ret; | 
| } | 
|   | 
| /* A chunk context tracks all I/O for moving one Read or Write | 
|  * chunk. This is a set of rdma_rw's that handle data movement | 
|  * for all segments of one chunk. | 
|  * | 
|  * These are small, acquired with a single allocator call, and | 
|  * no more than one is needed per chunk. They are allocated on | 
|  * demand, and not cached. | 
|  */ | 
| struct svc_rdma_chunk_ctxt { | 
|     struct rpc_rdma_cid    cc_cid; | 
|     struct ib_cqe        cc_cqe; | 
|     struct svcxprt_rdma    *cc_rdma; | 
|     struct list_head    cc_rwctxts; | 
|     int            cc_sqecount; | 
| }; | 
|   | 
| static void svc_rdma_cc_cid_init(struct svcxprt_rdma *rdma, | 
|                  struct rpc_rdma_cid *cid) | 
| { | 
|     cid->ci_queue_id = rdma->sc_sq_cq->res.id; | 
|     cid->ci_completion_id = atomic_inc_return(&rdma->sc_completion_ids); | 
| } | 
|   | 
| static void svc_rdma_cc_init(struct svcxprt_rdma *rdma, | 
|                  struct svc_rdma_chunk_ctxt *cc) | 
| { | 
|     svc_rdma_cc_cid_init(rdma, &cc->cc_cid); | 
|     cc->cc_rdma = rdma; | 
|   | 
|     INIT_LIST_HEAD(&cc->cc_rwctxts); | 
|     cc->cc_sqecount = 0; | 
| } | 
|   | 
| static void svc_rdma_cc_release(struct svc_rdma_chunk_ctxt *cc, | 
|                 enum dma_data_direction dir) | 
| { | 
|     struct svcxprt_rdma *rdma = cc->cc_rdma; | 
|     struct svc_rdma_rw_ctxt *ctxt; | 
|   | 
|     while ((ctxt = svc_rdma_next_ctxt(&cc->cc_rwctxts)) != NULL) { | 
|         list_del(&ctxt->rw_list); | 
|   | 
|         rdma_rw_ctx_destroy(&ctxt->rw_ctx, rdma->sc_qp, | 
|                     rdma->sc_port_num, ctxt->rw_sg_table.sgl, | 
|                     ctxt->rw_nents, dir); | 
|         svc_rdma_put_rw_ctxt(rdma, ctxt); | 
|     } | 
| } | 
|   | 
| /* State for sending a Write or Reply chunk. | 
|  *  - Tracks progress of writing one chunk over all its segments | 
|  *  - Stores arguments for the SGL constructor functions | 
|  */ | 
| struct svc_rdma_write_info { | 
|     /* write state of this chunk */ | 
|     unsigned int        wi_seg_off; | 
|     unsigned int        wi_seg_no; | 
|     unsigned int        wi_nsegs; | 
|     __be32            *wi_segs; | 
|   | 
|     /* SGL constructor arguments */ | 
|     struct xdr_buf        *wi_xdr; | 
|     unsigned char        *wi_base; | 
|     unsigned int        wi_next_off; | 
|   | 
|     struct svc_rdma_chunk_ctxt    wi_cc; | 
| }; | 
|   | 
| static struct svc_rdma_write_info * | 
| svc_rdma_write_info_alloc(struct svcxprt_rdma *rdma, __be32 *chunk) | 
| { | 
|     struct svc_rdma_write_info *info; | 
|   | 
|     info = kmalloc(sizeof(*info), GFP_KERNEL); | 
|     if (!info) | 
|         return info; | 
|   | 
|     info->wi_seg_off = 0; | 
|     info->wi_seg_no = 0; | 
|     info->wi_nsegs = be32_to_cpup(++chunk); | 
|     info->wi_segs = ++chunk; | 
|     svc_rdma_cc_init(rdma, &info->wi_cc); | 
|     info->wi_cc.cc_cqe.done = svc_rdma_write_done; | 
|     return info; | 
| } | 
|   | 
| static void svc_rdma_write_info_free(struct svc_rdma_write_info *info) | 
| { | 
|     svc_rdma_cc_release(&info->wi_cc, DMA_TO_DEVICE); | 
|     kfree(info); | 
| } | 
|   | 
| /** | 
|  * svc_rdma_write_done - Write chunk completion | 
|  * @cq: controlling Completion Queue | 
|  * @wc: Work Completion | 
|  * | 
|  * Pages under I/O are freed by a subsequent Send completion. | 
|  */ | 
| static void svc_rdma_write_done(struct ib_cq *cq, struct ib_wc *wc) | 
| { | 
|     struct ib_cqe *cqe = wc->wr_cqe; | 
|     struct svc_rdma_chunk_ctxt *cc = | 
|             container_of(cqe, struct svc_rdma_chunk_ctxt, cc_cqe); | 
|     struct svcxprt_rdma *rdma = cc->cc_rdma; | 
|     struct svc_rdma_write_info *info = | 
|             container_of(cc, struct svc_rdma_write_info, wi_cc); | 
|   | 
|     trace_svcrdma_wc_write(wc, &cc->cc_cid); | 
|   | 
|     atomic_add(cc->cc_sqecount, &rdma->sc_sq_avail); | 
|     wake_up(&rdma->sc_send_wait); | 
|   | 
|     if (unlikely(wc->status != IB_WC_SUCCESS)) | 
|         set_bit(XPT_CLOSE, &rdma->sc_xprt.xpt_flags); | 
|   | 
|     svc_rdma_write_info_free(info); | 
| } | 
|   | 
| /* State for pulling a Read chunk. | 
|  */ | 
| struct svc_rdma_read_info { | 
|     struct svc_rdma_recv_ctxt    *ri_readctxt; | 
|     unsigned int            ri_position; | 
|     unsigned int            ri_pageno; | 
|     unsigned int            ri_pageoff; | 
|     unsigned int            ri_chunklen; | 
|   | 
|     struct svc_rdma_chunk_ctxt    ri_cc; | 
| }; | 
|   | 
| static struct svc_rdma_read_info * | 
| svc_rdma_read_info_alloc(struct svcxprt_rdma *rdma) | 
| { | 
|     struct svc_rdma_read_info *info; | 
|   | 
|     info = kmalloc(sizeof(*info), GFP_KERNEL); | 
|     if (!info) | 
|         return info; | 
|   | 
|     svc_rdma_cc_init(rdma, &info->ri_cc); | 
|     info->ri_cc.cc_cqe.done = svc_rdma_wc_read_done; | 
|     return info; | 
| } | 
|   | 
| static void svc_rdma_read_info_free(struct svc_rdma_read_info *info) | 
| { | 
|     svc_rdma_cc_release(&info->ri_cc, DMA_FROM_DEVICE); | 
|     kfree(info); | 
| } | 
|   | 
| /** | 
|  * svc_rdma_wc_read_done - Handle completion of an RDMA Read ctx | 
|  * @cq: controlling Completion Queue | 
|  * @wc: Work Completion | 
|  * | 
|  */ | 
| static void svc_rdma_wc_read_done(struct ib_cq *cq, struct ib_wc *wc) | 
| { | 
|     struct ib_cqe *cqe = wc->wr_cqe; | 
|     struct svc_rdma_chunk_ctxt *cc = | 
|             container_of(cqe, struct svc_rdma_chunk_ctxt, cc_cqe); | 
|     struct svcxprt_rdma *rdma = cc->cc_rdma; | 
|     struct svc_rdma_read_info *info = | 
|             container_of(cc, struct svc_rdma_read_info, ri_cc); | 
|   | 
|     trace_svcrdma_wc_read(wc, &cc->cc_cid); | 
|   | 
|     atomic_add(cc->cc_sqecount, &rdma->sc_sq_avail); | 
|     wake_up(&rdma->sc_send_wait); | 
|   | 
|     if (unlikely(wc->status != IB_WC_SUCCESS)) { | 
|         set_bit(XPT_CLOSE, &rdma->sc_xprt.xpt_flags); | 
|         svc_rdma_recv_ctxt_put(rdma, info->ri_readctxt); | 
|     } else { | 
|         spin_lock(&rdma->sc_rq_dto_lock); | 
|         list_add_tail(&info->ri_readctxt->rc_list, | 
|                   &rdma->sc_read_complete_q); | 
|         /* Note the unlock pairs with the smp_rmb in svc_xprt_ready: */ | 
|         set_bit(XPT_DATA, &rdma->sc_xprt.xpt_flags); | 
|         spin_unlock(&rdma->sc_rq_dto_lock); | 
|   | 
|         svc_xprt_enqueue(&rdma->sc_xprt); | 
|     } | 
|   | 
|     svc_rdma_read_info_free(info); | 
| } | 
|   | 
| /* This function sleeps when the transport's Send Queue is congested. | 
|  * | 
|  * Assumptions: | 
|  * - If ib_post_send() succeeds, only one completion is expected, | 
|  *   even if one or more WRs are flushed. This is true when posting | 
|  *   an rdma_rw_ctx or when posting a single signaled WR. | 
|  */ | 
| static int svc_rdma_post_chunk_ctxt(struct svc_rdma_chunk_ctxt *cc) | 
| { | 
|     struct svcxprt_rdma *rdma = cc->cc_rdma; | 
|     struct svc_xprt *xprt = &rdma->sc_xprt; | 
|     struct ib_send_wr *first_wr; | 
|     const struct ib_send_wr *bad_wr; | 
|     struct list_head *tmp; | 
|     struct ib_cqe *cqe; | 
|     int ret; | 
|   | 
|     if (cc->cc_sqecount > rdma->sc_sq_depth) | 
|         return -EINVAL; | 
|   | 
|     first_wr = NULL; | 
|     cqe = &cc->cc_cqe; | 
|     list_for_each(tmp, &cc->cc_rwctxts) { | 
|         struct svc_rdma_rw_ctxt *ctxt; | 
|   | 
|         ctxt = list_entry(tmp, struct svc_rdma_rw_ctxt, rw_list); | 
|         first_wr = rdma_rw_ctx_wrs(&ctxt->rw_ctx, rdma->sc_qp, | 
|                        rdma->sc_port_num, cqe, first_wr); | 
|         cqe = NULL; | 
|     } | 
|   | 
|     do { | 
|         if (atomic_sub_return(cc->cc_sqecount, | 
|                       &rdma->sc_sq_avail) > 0) { | 
|             trace_svcrdma_post_chunk(&cc->cc_cid, cc->cc_sqecount); | 
|             ret = ib_post_send(rdma->sc_qp, first_wr, &bad_wr); | 
|             if (ret) | 
|                 break; | 
|             return 0; | 
|         } | 
|   | 
|         trace_svcrdma_sq_full(rdma); | 
|         atomic_add(cc->cc_sqecount, &rdma->sc_sq_avail); | 
|         wait_event(rdma->sc_send_wait, | 
|                atomic_read(&rdma->sc_sq_avail) > cc->cc_sqecount); | 
|         trace_svcrdma_sq_retry(rdma); | 
|     } while (1); | 
|   | 
|     trace_svcrdma_sq_post_err(rdma, ret); | 
|     set_bit(XPT_CLOSE, &xprt->xpt_flags); | 
|   | 
|     /* If even one was posted, there will be a completion. */ | 
|     if (bad_wr != first_wr) | 
|         return 0; | 
|   | 
|     atomic_add(cc->cc_sqecount, &rdma->sc_sq_avail); | 
|     wake_up(&rdma->sc_send_wait); | 
|     return -ENOTCONN; | 
| } | 
|   | 
| /* Build and DMA-map an SGL that covers one kvec in an xdr_buf | 
|  */ | 
| static void svc_rdma_vec_to_sg(struct svc_rdma_write_info *info, | 
|                    unsigned int len, | 
|                    struct svc_rdma_rw_ctxt *ctxt) | 
| { | 
|     struct scatterlist *sg = ctxt->rw_sg_table.sgl; | 
|   | 
|     sg_set_buf(&sg[0], info->wi_base, len); | 
|     info->wi_base += len; | 
|   | 
|     ctxt->rw_nents = 1; | 
| } | 
|   | 
| /* Build and DMA-map an SGL that covers part of an xdr_buf's pagelist. | 
|  */ | 
| static void svc_rdma_pagelist_to_sg(struct svc_rdma_write_info *info, | 
|                     unsigned int remaining, | 
|                     struct svc_rdma_rw_ctxt *ctxt) | 
| { | 
|     unsigned int sge_no, sge_bytes, page_off, page_no; | 
|     struct xdr_buf *xdr = info->wi_xdr; | 
|     struct scatterlist *sg; | 
|     struct page **page; | 
|   | 
|     page_off = info->wi_next_off + xdr->page_base; | 
|     page_no = page_off >> PAGE_SHIFT; | 
|     page_off = offset_in_page(page_off); | 
|     page = xdr->pages + page_no; | 
|     info->wi_next_off += remaining; | 
|     sg = ctxt->rw_sg_table.sgl; | 
|     sge_no = 0; | 
|     do { | 
|         sge_bytes = min_t(unsigned int, remaining, | 
|                   PAGE_SIZE - page_off); | 
|         sg_set_page(sg, *page, sge_bytes, page_off); | 
|   | 
|         remaining -= sge_bytes; | 
|         sg = sg_next(sg); | 
|         page_off = 0; | 
|         sge_no++; | 
|         page++; | 
|     } while (remaining); | 
|   | 
|     ctxt->rw_nents = sge_no; | 
| } | 
|   | 
| /* Construct RDMA Write WRs to send a portion of an xdr_buf containing | 
|  * an RPC Reply. | 
|  */ | 
| static int | 
| svc_rdma_build_writes(struct svc_rdma_write_info *info, | 
|               void (*constructor)(struct svc_rdma_write_info *info, | 
|                       unsigned int len, | 
|                       struct svc_rdma_rw_ctxt *ctxt), | 
|               unsigned int remaining) | 
| { | 
|     struct svc_rdma_chunk_ctxt *cc = &info->wi_cc; | 
|     struct svcxprt_rdma *rdma = cc->cc_rdma; | 
|     struct svc_rdma_rw_ctxt *ctxt; | 
|     __be32 *seg; | 
|     int ret; | 
|   | 
|     seg = info->wi_segs + info->wi_seg_no * rpcrdma_segment_maxsz; | 
|     do { | 
|         unsigned int write_len; | 
|         u32 handle, length; | 
|         u64 offset; | 
|   | 
|         if (info->wi_seg_no >= info->wi_nsegs) | 
|             goto out_overflow; | 
|   | 
|         xdr_decode_rdma_segment(seg, &handle, &length, &offset); | 
|         offset += info->wi_seg_off; | 
|   | 
|         write_len = min(remaining, length - info->wi_seg_off); | 
|         ctxt = svc_rdma_get_rw_ctxt(rdma, | 
|                         (write_len >> PAGE_SHIFT) + 2); | 
|         if (!ctxt) | 
|             return -ENOMEM; | 
|   | 
|         constructor(info, write_len, ctxt); | 
|         ret = svc_rdma_rw_ctx_init(rdma, ctxt, offset, handle, | 
|                        DMA_TO_DEVICE); | 
|         if (ret < 0) | 
|             return -EIO; | 
|   | 
|         trace_svcrdma_send_wseg(handle, write_len, offset); | 
|   | 
|         list_add(&ctxt->rw_list, &cc->cc_rwctxts); | 
|         cc->cc_sqecount += ret; | 
|         if (write_len == length - info->wi_seg_off) { | 
|             seg += 4; | 
|             info->wi_seg_no++; | 
|             info->wi_seg_off = 0; | 
|         } else { | 
|             info->wi_seg_off += write_len; | 
|         } | 
|         remaining -= write_len; | 
|     } while (remaining); | 
|   | 
|     return 0; | 
|   | 
| out_overflow: | 
|     trace_svcrdma_small_wrch_err(rdma, remaining, info->wi_seg_no, | 
|                      info->wi_nsegs); | 
|     return -E2BIG; | 
| } | 
|   | 
| /* Send one of an xdr_buf's kvecs by itself. To send a Reply | 
|  * chunk, the whole RPC Reply is written back to the client. | 
|  * This function writes either the head or tail of the xdr_buf | 
|  * containing the Reply. | 
|  */ | 
| static int svc_rdma_send_xdr_kvec(struct svc_rdma_write_info *info, | 
|                   struct kvec *vec) | 
| { | 
|     info->wi_base = vec->iov_base; | 
|     return svc_rdma_build_writes(info, svc_rdma_vec_to_sg, | 
|                      vec->iov_len); | 
| } | 
|   | 
| /* Send an xdr_buf's page list by itself. A Write chunk is just | 
|  * the page list. A Reply chunk is @xdr's head, page list, and | 
|  * tail. This function is shared between the two types of chunk. | 
|  */ | 
| static int svc_rdma_send_xdr_pagelist(struct svc_rdma_write_info *info, | 
|                       struct xdr_buf *xdr, | 
|                       unsigned int offset, | 
|                       unsigned long length) | 
| { | 
|     info->wi_xdr = xdr; | 
|     info->wi_next_off = offset - xdr->head[0].iov_len; | 
|     return svc_rdma_build_writes(info, svc_rdma_pagelist_to_sg, | 
|                      length); | 
| } | 
|   | 
| /** | 
|  * svc_rdma_send_write_chunk - Write all segments in a Write chunk | 
|  * @rdma: controlling RDMA transport | 
|  * @wr_ch: Write chunk provided by client | 
|  * @xdr: xdr_buf containing the data payload | 
|  * @offset: payload's byte offset in @xdr | 
|  * @length: size of payload, in bytes | 
|  * | 
|  * Returns a non-negative number of bytes the chunk consumed, or | 
|  *    %-E2BIG if the payload was larger than the Write chunk, | 
|  *    %-EINVAL if client provided too many segments, | 
|  *    %-ENOMEM if rdma_rw context pool was exhausted, | 
|  *    %-ENOTCONN if posting failed (connection is lost), | 
|  *    %-EIO if rdma_rw initialization failed (DMA mapping, etc). | 
|  */ | 
| int svc_rdma_send_write_chunk(struct svcxprt_rdma *rdma, __be32 *wr_ch, | 
|                   struct xdr_buf *xdr, | 
|                   unsigned int offset, unsigned long length) | 
| { | 
|     struct svc_rdma_write_info *info; | 
|     int ret; | 
|   | 
|     if (!length) | 
|         return 0; | 
|   | 
|     info = svc_rdma_write_info_alloc(rdma, wr_ch); | 
|     if (!info) | 
|         return -ENOMEM; | 
|   | 
|     ret = svc_rdma_send_xdr_pagelist(info, xdr, offset, length); | 
|     if (ret < 0) | 
|         goto out_err; | 
|   | 
|     ret = svc_rdma_post_chunk_ctxt(&info->wi_cc); | 
|     if (ret < 0) | 
|         goto out_err; | 
|   | 
|     trace_svcrdma_send_write_chunk(xdr->page_len); | 
|     return length; | 
|   | 
| out_err: | 
|     svc_rdma_write_info_free(info); | 
|     return ret; | 
| } | 
|   | 
| /** | 
|  * svc_rdma_send_reply_chunk - Write all segments in the Reply chunk | 
|  * @rdma: controlling RDMA transport | 
|  * @rctxt: Write and Reply chunks from client | 
|  * @xdr: xdr_buf containing an RPC Reply | 
|  * | 
|  * Returns a non-negative number of bytes the chunk consumed, or | 
|  *    %-E2BIG if the payload was larger than the Reply chunk, | 
|  *    %-EINVAL if client provided too many segments, | 
|  *    %-ENOMEM if rdma_rw context pool was exhausted, | 
|  *    %-ENOTCONN if posting failed (connection is lost), | 
|  *    %-EIO if rdma_rw initialization failed (DMA mapping, etc). | 
|  */ | 
| int svc_rdma_send_reply_chunk(struct svcxprt_rdma *rdma, | 
|                   const struct svc_rdma_recv_ctxt *rctxt, | 
|                   struct xdr_buf *xdr) | 
| { | 
|     struct svc_rdma_write_info *info; | 
|     int consumed, ret; | 
|   | 
|     info = svc_rdma_write_info_alloc(rdma, rctxt->rc_reply_chunk); | 
|     if (!info) | 
|         return -ENOMEM; | 
|   | 
|     ret = svc_rdma_send_xdr_kvec(info, &xdr->head[0]); | 
|     if (ret < 0) | 
|         goto out_err; | 
|     consumed = xdr->head[0].iov_len; | 
|   | 
|     /* Send the page list in the Reply chunk only if the | 
|      * client did not provide Write chunks. | 
|      */ | 
|     if (!rctxt->rc_write_list && xdr->page_len) { | 
|         ret = svc_rdma_send_xdr_pagelist(info, xdr, | 
|                          xdr->head[0].iov_len, | 
|                          xdr->page_len); | 
|         if (ret < 0) | 
|             goto out_err; | 
|         consumed += xdr->page_len; | 
|     } | 
|   | 
|     if (xdr->tail[0].iov_len) { | 
|         ret = svc_rdma_send_xdr_kvec(info, &xdr->tail[0]); | 
|         if (ret < 0) | 
|             goto out_err; | 
|         consumed += xdr->tail[0].iov_len; | 
|     } | 
|   | 
|     ret = svc_rdma_post_chunk_ctxt(&info->wi_cc); | 
|     if (ret < 0) | 
|         goto out_err; | 
|   | 
|     trace_svcrdma_send_reply_chunk(consumed); | 
|     return consumed; | 
|   | 
| out_err: | 
|     svc_rdma_write_info_free(info); | 
|     return ret; | 
| } | 
|   | 
| static int svc_rdma_build_read_segment(struct svc_rdma_read_info *info, | 
|                        struct svc_rqst *rqstp, | 
|                        u32 rkey, u32 len, u64 offset) | 
| { | 
|     struct svc_rdma_recv_ctxt *head = info->ri_readctxt; | 
|     struct svc_rdma_chunk_ctxt *cc = &info->ri_cc; | 
|     struct svc_rdma_rw_ctxt *ctxt; | 
|     unsigned int sge_no, seg_len; | 
|     struct scatterlist *sg; | 
|     int ret; | 
|   | 
|     sge_no = PAGE_ALIGN(info->ri_pageoff + len) >> PAGE_SHIFT; | 
|     ctxt = svc_rdma_get_rw_ctxt(cc->cc_rdma, sge_no); | 
|     if (!ctxt) | 
|         return -ENOMEM; | 
|     ctxt->rw_nents = sge_no; | 
|   | 
|     sg = ctxt->rw_sg_table.sgl; | 
|     for (sge_no = 0; sge_no < ctxt->rw_nents; sge_no++) { | 
|         seg_len = min_t(unsigned int, len, | 
|                 PAGE_SIZE - info->ri_pageoff); | 
|   | 
|         head->rc_arg.pages[info->ri_pageno] = | 
|             rqstp->rq_pages[info->ri_pageno]; | 
|         if (!info->ri_pageoff) | 
|             head->rc_page_count++; | 
|   | 
|         sg_set_page(sg, rqstp->rq_pages[info->ri_pageno], | 
|                 seg_len, info->ri_pageoff); | 
|         sg = sg_next(sg); | 
|   | 
|         info->ri_pageoff += seg_len; | 
|         if (info->ri_pageoff == PAGE_SIZE) { | 
|             info->ri_pageno++; | 
|             info->ri_pageoff = 0; | 
|         } | 
|         len -= seg_len; | 
|   | 
|         /* Safety check */ | 
|         if (len && | 
|             &rqstp->rq_pages[info->ri_pageno + 1] > rqstp->rq_page_end) | 
|             goto out_overrun; | 
|     } | 
|   | 
|     ret = svc_rdma_rw_ctx_init(cc->cc_rdma, ctxt, offset, rkey, | 
|                    DMA_FROM_DEVICE); | 
|     if (ret < 0) | 
|         return -EIO; | 
|   | 
|     list_add(&ctxt->rw_list, &cc->cc_rwctxts); | 
|     cc->cc_sqecount += ret; | 
|     return 0; | 
|   | 
| out_overrun: | 
|     trace_svcrdma_page_overrun_err(cc->cc_rdma, rqstp, info->ri_pageno); | 
|     return -EINVAL; | 
| } | 
|   | 
| /* Walk the segments in the Read chunk starting at @p and construct | 
|  * RDMA Read operations to pull the chunk to the server. | 
|  */ | 
| static int svc_rdma_build_read_chunk(struct svc_rqst *rqstp, | 
|                      struct svc_rdma_read_info *info, | 
|                      __be32 *p) | 
| { | 
|     int ret; | 
|   | 
|     ret = -EINVAL; | 
|     info->ri_chunklen = 0; | 
|     while (*p++ != xdr_zero && be32_to_cpup(p++) == info->ri_position) { | 
|         u32 handle, length; | 
|         u64 offset; | 
|   | 
|         p = xdr_decode_rdma_segment(p, &handle, &length, &offset); | 
|         ret = svc_rdma_build_read_segment(info, rqstp, handle, length, | 
|                           offset); | 
|         if (ret < 0) | 
|             break; | 
|   | 
|         trace_svcrdma_send_rseg(handle, length, offset); | 
|         info->ri_chunklen += length; | 
|     } | 
|   | 
|     return ret; | 
| } | 
|   | 
| /* Construct RDMA Reads to pull over a normal Read chunk. The chunk | 
|  * data lands in the page list of head->rc_arg.pages. | 
|  * | 
|  * Currently NFSD does not look at the head->rc_arg.tail[0] iovec. | 
|  * Therefore, XDR round-up of the Read chunk and trailing | 
|  * inline content must both be added at the end of the pagelist. | 
|  */ | 
| static int svc_rdma_build_normal_read_chunk(struct svc_rqst *rqstp, | 
|                         struct svc_rdma_read_info *info, | 
|                         __be32 *p) | 
| { | 
|     struct svc_rdma_recv_ctxt *head = info->ri_readctxt; | 
|     int ret; | 
|   | 
|     ret = svc_rdma_build_read_chunk(rqstp, info, p); | 
|     if (ret < 0) | 
|         goto out; | 
|   | 
|     trace_svcrdma_send_read_chunk(info->ri_chunklen, info->ri_position); | 
|   | 
|     head->rc_hdr_count = 0; | 
|   | 
|     /* Split the Receive buffer between the head and tail | 
|      * buffers at Read chunk's position. XDR roundup of the | 
|      * chunk is not included in either the pagelist or in | 
|      * the tail. | 
|      */ | 
|     head->rc_arg.tail[0].iov_base = | 
|         head->rc_arg.head[0].iov_base + info->ri_position; | 
|     head->rc_arg.tail[0].iov_len = | 
|         head->rc_arg.head[0].iov_len - info->ri_position; | 
|     head->rc_arg.head[0].iov_len = info->ri_position; | 
|   | 
|     /* Read chunk may need XDR roundup (see RFC 8166, s. 3.4.5.2). | 
|      * | 
|      * If the client already rounded up the chunk length, the | 
|      * length does not change. Otherwise, the length of the page | 
|      * list is increased to include XDR round-up. | 
|      * | 
|      * Currently these chunks always start at page offset 0, | 
|      * thus the rounded-up length never crosses a page boundary. | 
|      */ | 
|     info->ri_chunklen = XDR_QUADLEN(info->ri_chunklen) << 2; | 
|   | 
|     head->rc_arg.page_len = info->ri_chunklen; | 
|     head->rc_arg.len += info->ri_chunklen; | 
|     head->rc_arg.buflen += info->ri_chunklen; | 
|   | 
| out: | 
|     return ret; | 
| } | 
|   | 
| /* Construct RDMA Reads to pull over a Position Zero Read chunk. | 
|  * The start of the data lands in the first page just after | 
|  * the Transport header, and the rest lands in the page list of | 
|  * head->rc_arg.pages. | 
|  * | 
|  * Assumptions: | 
|  *    - A PZRC has an XDR-aligned length (no implicit round-up). | 
|  *    - There can be no trailing inline content (IOW, we assume | 
|  *      a PZRC is never sent in an RDMA_MSG message, though it's | 
|  *      allowed by spec). | 
|  */ | 
| static int svc_rdma_build_pz_read_chunk(struct svc_rqst *rqstp, | 
|                     struct svc_rdma_read_info *info, | 
|                     __be32 *p) | 
| { | 
|     struct svc_rdma_recv_ctxt *head = info->ri_readctxt; | 
|     int ret; | 
|   | 
|     ret = svc_rdma_build_read_chunk(rqstp, info, p); | 
|     if (ret < 0) | 
|         goto out; | 
|   | 
|     trace_svcrdma_send_pzr(info->ri_chunklen); | 
|   | 
|     head->rc_arg.len += info->ri_chunklen; | 
|     head->rc_arg.buflen += info->ri_chunklen; | 
|   | 
|     head->rc_hdr_count = 1; | 
|     head->rc_arg.head[0].iov_base = page_address(head->rc_pages[0]); | 
|     head->rc_arg.head[0].iov_len = min_t(size_t, PAGE_SIZE, | 
|                          info->ri_chunklen); | 
|   | 
|     head->rc_arg.page_len = info->ri_chunklen - | 
|                 head->rc_arg.head[0].iov_len; | 
|   | 
| out: | 
|     return ret; | 
| } | 
|   | 
| /* Pages under I/O have been copied to head->rc_pages. Ensure they | 
|  * are not released by svc_xprt_release() until the I/O is complete. | 
|  * | 
|  * This has to be done after all Read WRs are constructed to properly | 
|  * handle a page that is part of I/O on behalf of two different RDMA | 
|  * segments. | 
|  * | 
|  * Do this only if I/O has been posted. Otherwise, we do indeed want | 
|  * svc_xprt_release() to clean things up properly. | 
|  */ | 
| static void svc_rdma_save_io_pages(struct svc_rqst *rqstp, | 
|                    const unsigned int start, | 
|                    const unsigned int num_pages) | 
| { | 
|     unsigned int i; | 
|   | 
|     for (i = start; i < num_pages + start; i++) | 
|         rqstp->rq_pages[i] = NULL; | 
| } | 
|   | 
| /** | 
|  * svc_rdma_recv_read_chunk - Pull a Read chunk from the client | 
|  * @rdma: controlling RDMA transport | 
|  * @rqstp: set of pages to use as Read sink buffers | 
|  * @head: pages under I/O collect here | 
|  * @p: pointer to start of Read chunk | 
|  * | 
|  * Returns: | 
|  *    %0 if all needed RDMA Reads were posted successfully, | 
|  *    %-EINVAL if client provided too many segments, | 
|  *    %-ENOMEM if rdma_rw context pool was exhausted, | 
|  *    %-ENOTCONN if posting failed (connection is lost), | 
|  *    %-EIO if rdma_rw initialization failed (DMA mapping, etc). | 
|  * | 
|  * Assumptions: | 
|  * - All Read segments in @p have the same Position value. | 
|  */ | 
| int svc_rdma_recv_read_chunk(struct svcxprt_rdma *rdma, struct svc_rqst *rqstp, | 
|                  struct svc_rdma_recv_ctxt *head, __be32 *p) | 
| { | 
|     struct svc_rdma_read_info *info; | 
|     int ret; | 
|   | 
|     /* The request (with page list) is constructed in | 
|      * head->rc_arg. Pages involved with RDMA Read I/O are | 
|      * transferred there. | 
|      */ | 
|     head->rc_arg.head[0] = rqstp->rq_arg.head[0]; | 
|     head->rc_arg.tail[0] = rqstp->rq_arg.tail[0]; | 
|     head->rc_arg.pages = head->rc_pages; | 
|     head->rc_arg.page_base = 0; | 
|     head->rc_arg.page_len = 0; | 
|     head->rc_arg.len = rqstp->rq_arg.len; | 
|     head->rc_arg.buflen = rqstp->rq_arg.buflen; | 
|   | 
|     info = svc_rdma_read_info_alloc(rdma); | 
|     if (!info) | 
|         return -ENOMEM; | 
|     info->ri_readctxt = head; | 
|     info->ri_pageno = 0; | 
|     info->ri_pageoff = 0; | 
|   | 
|     info->ri_position = be32_to_cpup(p + 1); | 
|     if (info->ri_position) | 
|         ret = svc_rdma_build_normal_read_chunk(rqstp, info, p); | 
|     else | 
|         ret = svc_rdma_build_pz_read_chunk(rqstp, info, p); | 
|     if (ret < 0) | 
|         goto out_err; | 
|   | 
|     ret = svc_rdma_post_chunk_ctxt(&info->ri_cc); | 
|     if (ret < 0) | 
|         goto out_err; | 
|     svc_rdma_save_io_pages(rqstp, 0, head->rc_page_count); | 
|     return 0; | 
|   | 
| out_err: | 
|     svc_rdma_read_info_free(info); | 
|     return ret; | 
| } |