Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 1 | /* |
Steve Wise | 0bf4828 | 2014-05-28 15:12:01 -0500 | [diff] [blame] | 2 | * Copyright (c) 2014 Open Grid Computing, Inc. All rights reserved. |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 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 | |
| 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 | |
Chuck Lever | cf570a9 | 2016-03-01 13:05:45 -0500 | [diff] [blame] | 53 | static u32 xdr_padsize(u32 len) |
| 54 | { |
| 55 | return (len & 3) ? (4 - (len & 3)) : 0; |
| 56 | } |
| 57 | |
Chuck Lever | ba986c9 | 2016-01-07 14:49:53 -0500 | [diff] [blame] | 58 | int svc_rdma_map_xdr(struct svcxprt_rdma *xprt, |
| 59 | struct xdr_buf *xdr, |
Chuck Lever | f6763c2 | 2016-03-01 13:05:54 -0500 | [diff] [blame] | 60 | struct svc_rdma_req_map *vec, |
| 61 | bool write_chunk_present) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 62 | { |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 63 | int sge_no; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 64 | u32 sge_bytes; |
| 65 | u32 page_bytes; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 66 | u32 page_off; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 67 | int page_no; |
| 68 | |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 69 | if (xdr->len != |
| 70 | (xdr->head[0].iov_len + xdr->page_len + xdr->tail[0].iov_len)) { |
Chuck Lever | ba986c9 | 2016-01-07 14:49:53 -0500 | [diff] [blame] | 71 | pr_err("svcrdma: %s: XDR buffer length error\n", __func__); |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 72 | return -EIO; |
| 73 | } |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 74 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 75 | /* Skip the first sge, this is for the RPCRDMA header */ |
| 76 | sge_no = 1; |
| 77 | |
| 78 | /* Head SGE */ |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 79 | vec->sge[sge_no].iov_base = xdr->head[0].iov_base; |
| 80 | vec->sge[sge_no].iov_len = xdr->head[0].iov_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 81 | sge_no++; |
| 82 | |
| 83 | /* pages SGE */ |
| 84 | page_no = 0; |
| 85 | page_bytes = xdr->page_len; |
| 86 | page_off = xdr->page_base; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 87 | while (page_bytes) { |
| 88 | vec->sge[sge_no].iov_base = |
| 89 | page_address(xdr->pages[page_no]) + page_off; |
| 90 | sge_bytes = min_t(u32, page_bytes, (PAGE_SIZE - page_off)); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 91 | page_bytes -= sge_bytes; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 92 | vec->sge[sge_no].iov_len = sge_bytes; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 93 | |
| 94 | sge_no++; |
| 95 | page_no++; |
| 96 | page_off = 0; /* reset for next time through loop */ |
| 97 | } |
| 98 | |
| 99 | /* Tail SGE */ |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 100 | if (xdr->tail[0].iov_len) { |
Chuck Lever | f6763c2 | 2016-03-01 13:05:54 -0500 | [diff] [blame] | 101 | unsigned char *base = xdr->tail[0].iov_base; |
| 102 | size_t len = xdr->tail[0].iov_len; |
| 103 | u32 xdr_pad = xdr_padsize(xdr->page_len); |
| 104 | |
| 105 | if (write_chunk_present && xdr_pad) { |
| 106 | base += xdr_pad; |
| 107 | len -= xdr_pad; |
| 108 | } |
| 109 | |
| 110 | if (len) { |
| 111 | vec->sge[sge_no].iov_base = base; |
| 112 | vec->sge[sge_no].iov_len = len; |
| 113 | sge_no++; |
| 114 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 115 | } |
| 116 | |
Chuck Lever | ba986c9 | 2016-01-07 14:49:53 -0500 | [diff] [blame] | 117 | dprintk("svcrdma: %s: sge_no %d page_no %d " |
Tom Talpey | 2e3c230 | 2009-03-12 22:21:21 -0400 | [diff] [blame] | 118 | "page_base %u page_len %u head_len %zu tail_len %zu\n", |
Chuck Lever | ba986c9 | 2016-01-07 14:49:53 -0500 | [diff] [blame] | 119 | __func__, sge_no, page_no, xdr->page_base, xdr->page_len, |
Tom Talpey | b1e1e15 | 2009-03-11 14:37:55 -0400 | [diff] [blame] | 120 | xdr->head[0].iov_len, xdr->tail[0].iov_len); |
| 121 | |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 122 | vec->count = sge_no; |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 123 | return 0; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 124 | } |
| 125 | |
Tom Tucker | b432e6b | 2010-10-12 15:33:52 -0500 | [diff] [blame] | 126 | static dma_addr_t dma_map_xdr(struct svcxprt_rdma *xprt, |
| 127 | struct xdr_buf *xdr, |
| 128 | u32 xdr_off, size_t len, int dir) |
| 129 | { |
| 130 | struct page *page; |
| 131 | dma_addr_t dma_addr; |
| 132 | if (xdr_off < xdr->head[0].iov_len) { |
| 133 | /* This offset is in the head */ |
| 134 | xdr_off += (unsigned long)xdr->head[0].iov_base & ~PAGE_MASK; |
| 135 | page = virt_to_page(xdr->head[0].iov_base); |
| 136 | } else { |
| 137 | xdr_off -= xdr->head[0].iov_len; |
| 138 | if (xdr_off < xdr->page_len) { |
| 139 | /* This offset is in the page list */ |
Jeff Layton | 3cbe01a | 2014-03-17 13:10:05 -0400 | [diff] [blame] | 140 | xdr_off += xdr->page_base; |
Tom Tucker | b432e6b | 2010-10-12 15:33:52 -0500 | [diff] [blame] | 141 | page = xdr->pages[xdr_off >> PAGE_SHIFT]; |
| 142 | xdr_off &= ~PAGE_MASK; |
| 143 | } else { |
| 144 | /* This offset is in the tail */ |
| 145 | xdr_off -= xdr->page_len; |
| 146 | xdr_off += (unsigned long) |
| 147 | xdr->tail[0].iov_base & ~PAGE_MASK; |
| 148 | page = virt_to_page(xdr->tail[0].iov_base); |
| 149 | } |
| 150 | } |
| 151 | dma_addr = ib_dma_map_page(xprt->sc_cm_id->device, page, xdr_off, |
| 152 | min_t(size_t, PAGE_SIZE, len), dir); |
| 153 | return dma_addr; |
| 154 | } |
| 155 | |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 156 | /* Parse the RPC Call's transport header. |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 157 | */ |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 158 | static void svc_rdma_get_write_arrays(struct rpcrdma_msg *rmsgp, |
| 159 | struct rpcrdma_write_array **write, |
| 160 | struct rpcrdma_write_array **reply) |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 161 | { |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 162 | __be32 *p; |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 163 | |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 164 | p = (__be32 *)&rmsgp->rm_body.rm_chunks[0]; |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 165 | |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 166 | /* Read list */ |
| 167 | while (*p++ != xdr_zero) |
| 168 | p += 5; |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 169 | |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 170 | /* Write list */ |
| 171 | if (*p != xdr_zero) { |
| 172 | *write = (struct rpcrdma_write_array *)p; |
| 173 | while (*p++ != xdr_zero) |
| 174 | p += 1 + be32_to_cpu(*p) * 4; |
| 175 | } else { |
| 176 | *write = NULL; |
| 177 | p++; |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 178 | } |
| 179 | |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 180 | /* Reply chunk */ |
| 181 | if (*p != xdr_zero) |
| 182 | *reply = (struct rpcrdma_write_array *)p; |
| 183 | else |
| 184 | *reply = NULL; |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 185 | } |
| 186 | |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 187 | /* RPC-over-RDMA Version One private extension: Remote Invalidation. |
| 188 | * Responder's choice: requester signals it can handle Send With |
| 189 | * Invalidate, and responder chooses one rkey to invalidate. |
| 190 | * |
| 191 | * Find a candidate rkey to invalidate when sending a reply. Picks the |
| 192 | * first rkey it finds in the chunks lists. |
| 193 | * |
| 194 | * Returns zero if RPC's chunk lists are empty. |
| 195 | */ |
| 196 | static u32 svc_rdma_get_inv_rkey(struct rpcrdma_msg *rdma_argp, |
| 197 | struct rpcrdma_write_array *wr_ary, |
| 198 | struct rpcrdma_write_array *rp_ary) |
| 199 | { |
| 200 | struct rpcrdma_read_chunk *rd_ary; |
| 201 | struct rpcrdma_segment *arg_ch; |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 202 | |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 203 | rd_ary = (struct rpcrdma_read_chunk *)&rdma_argp->rm_body.rm_chunks[0]; |
Chuck Lever | fafedf8 | 2016-11-29 11:05:39 -0500 | [diff] [blame] | 204 | if (rd_ary->rc_discrim != xdr_zero) |
| 205 | return be32_to_cpu(rd_ary->rc_target.rs_handle); |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 206 | |
| 207 | if (wr_ary && be32_to_cpu(wr_ary->wc_nchunks)) { |
| 208 | arg_ch = &wr_ary->wc_array[0].wc_target; |
Chuck Lever | fafedf8 | 2016-11-29 11:05:39 -0500 | [diff] [blame] | 209 | return be32_to_cpu(arg_ch->rs_handle); |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 210 | } |
| 211 | |
| 212 | if (rp_ary && be32_to_cpu(rp_ary->wc_nchunks)) { |
| 213 | arg_ch = &rp_ary->wc_array[0].wc_target; |
Chuck Lever | fafedf8 | 2016-11-29 11:05:39 -0500 | [diff] [blame] | 214 | return be32_to_cpu(arg_ch->rs_handle); |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 215 | } |
| 216 | |
Chuck Lever | fafedf8 | 2016-11-29 11:05:39 -0500 | [diff] [blame] | 217 | return 0; |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 218 | } |
| 219 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 220 | /* Assumptions: |
| 221 | * - The specified write_len can be represented in sc_max_sge * PAGE_SIZE |
| 222 | */ |
| 223 | static int send_write(struct svcxprt_rdma *xprt, struct svc_rqst *rqstp, |
| 224 | u32 rmr, u64 to, |
| 225 | u32 xdr_off, int write_len, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 226 | struct svc_rdma_req_map *vec) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 227 | { |
Christoph Hellwig | e622f2f | 2015-10-08 09:16:33 +0100 | [diff] [blame] | 228 | struct ib_rdma_wr write_wr; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 229 | struct ib_sge *sge; |
| 230 | int xdr_sge_no; |
| 231 | int sge_no; |
| 232 | int sge_bytes; |
| 233 | int sge_off; |
| 234 | int bc; |
| 235 | struct svc_rdma_op_ctxt *ctxt; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 236 | |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 237 | if (vec->count > RPCSVC_MAXPAGES) { |
| 238 | pr_err("svcrdma: Too many pages (%lu)\n", vec->count); |
| 239 | return -EIO; |
| 240 | } |
| 241 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 242 | dprintk("svcrdma: RDMA_WRITE rmr=%x, to=%llx, xdr_off=%d, " |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 243 | "write_len=%d, vec->sge=%p, vec->count=%lu\n", |
Roland Dreier | bb50c80 | 2008-02-08 16:02:04 -0800 | [diff] [blame] | 244 | rmr, (unsigned long long)to, xdr_off, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 245 | write_len, vec->sge, vec->count); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 246 | |
| 247 | ctxt = svc_rdma_get_context(xprt); |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 248 | ctxt->direction = DMA_TO_DEVICE; |
| 249 | sge = ctxt->sge; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 250 | |
| 251 | /* Find the SGE associated with xdr_off */ |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 252 | for (bc = xdr_off, xdr_sge_no = 1; bc && xdr_sge_no < vec->count; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 253 | xdr_sge_no++) { |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 254 | if (vec->sge[xdr_sge_no].iov_len > bc) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 255 | break; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 256 | bc -= vec->sge[xdr_sge_no].iov_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 257 | } |
| 258 | |
| 259 | sge_off = bc; |
| 260 | bc = write_len; |
| 261 | sge_no = 0; |
| 262 | |
| 263 | /* Copy the remaining SGE */ |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 264 | while (bc != 0) { |
| 265 | sge_bytes = min_t(size_t, |
| 266 | bc, vec->sge[xdr_sge_no].iov_len-sge_off); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 267 | sge[sge_no].length = sge_bytes; |
Steve Wise | 0bf4828 | 2014-05-28 15:12:01 -0500 | [diff] [blame] | 268 | sge[sge_no].addr = |
| 269 | dma_map_xdr(xprt, &rqstp->rq_res, xdr_off, |
| 270 | sge_bytes, DMA_TO_DEVICE); |
| 271 | xdr_off += sge_bytes; |
| 272 | if (ib_dma_mapping_error(xprt->sc_cm_id->device, |
| 273 | sge[sge_no].addr)) |
| 274 | goto err; |
Chuck Lever | cace564 | 2016-09-13 10:52:50 -0400 | [diff] [blame] | 275 | svc_rdma_count_mappings(xprt, ctxt); |
Christoph Hellwig | 5fe1043 | 2016-01-07 23:53:41 -0800 | [diff] [blame] | 276 | sge[sge_no].lkey = xprt->sc_pd->local_dma_lkey; |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 277 | ctxt->count++; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 278 | sge_off = 0; |
| 279 | sge_no++; |
| 280 | xdr_sge_no++; |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 281 | if (xdr_sge_no > vec->count) { |
| 282 | pr_err("svcrdma: Too many sges (%d)\n", xdr_sge_no); |
| 283 | goto err; |
| 284 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 285 | bc -= sge_bytes; |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 286 | if (sge_no == xprt->sc_max_sge) |
| 287 | break; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 288 | } |
| 289 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 290 | /* Prepare WRITE WR */ |
| 291 | memset(&write_wr, 0, sizeof write_wr); |
Chuck Lever | be99bb1 | 2016-03-01 13:07:22 -0500 | [diff] [blame] | 292 | ctxt->cqe.done = svc_rdma_wc_write; |
| 293 | write_wr.wr.wr_cqe = &ctxt->cqe; |
Christoph Hellwig | e622f2f | 2015-10-08 09:16:33 +0100 | [diff] [blame] | 294 | write_wr.wr.sg_list = &sge[0]; |
| 295 | write_wr.wr.num_sge = sge_no; |
| 296 | write_wr.wr.opcode = IB_WR_RDMA_WRITE; |
| 297 | write_wr.wr.send_flags = IB_SEND_SIGNALED; |
| 298 | write_wr.rkey = rmr; |
| 299 | write_wr.remote_addr = to; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 300 | |
| 301 | /* Post It */ |
| 302 | atomic_inc(&rdma_stat_write); |
Christoph Hellwig | e622f2f | 2015-10-08 09:16:33 +0100 | [diff] [blame] | 303 | if (svc_rdma_send(xprt, &write_wr.wr)) |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 304 | goto err; |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 305 | return write_len - bc; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 306 | err: |
Tom Tucker | 4a84386 | 2010-10-12 15:33:57 -0500 | [diff] [blame] | 307 | svc_rdma_unmap_dma(ctxt); |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 308 | svc_rdma_put_context(ctxt, 0); |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 309 | return -EIO; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 310 | } |
| 311 | |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 312 | noinline |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 313 | static int send_write_chunks(struct svcxprt_rdma *xprt, |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 314 | struct rpcrdma_write_array *wr_ary, |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 315 | struct rpcrdma_msg *rdma_resp, |
| 316 | struct svc_rqst *rqstp, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 317 | struct svc_rdma_req_map *vec) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 318 | { |
Chuck Lever | cf570a9 | 2016-03-01 13:05:45 -0500 | [diff] [blame] | 319 | u32 xfer_len = rqstp->rq_res.page_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 320 | int write_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 321 | u32 xdr_off; |
| 322 | int chunk_off; |
| 323 | int chunk_no; |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 324 | int nchunks; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 325 | struct rpcrdma_write_array *res_ary; |
| 326 | int ret; |
| 327 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 328 | res_ary = (struct rpcrdma_write_array *) |
| 329 | &rdma_resp->rm_body.rm_chunks[1]; |
| 330 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 331 | /* Write chunks start at the pagelist */ |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 332 | nchunks = be32_to_cpu(wr_ary->wc_nchunks); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 333 | for (xdr_off = rqstp->rq_res.head[0].iov_len, chunk_no = 0; |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 334 | xfer_len && chunk_no < nchunks; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 335 | chunk_no++) { |
| 336 | struct rpcrdma_segment *arg_ch; |
| 337 | u64 rs_offset; |
| 338 | |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 339 | arg_ch = &wr_ary->wc_array[chunk_no].wc_target; |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 340 | write_len = min(xfer_len, be32_to_cpu(arg_ch->rs_length)); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 341 | |
| 342 | /* Prepare the response chunk given the length actually |
| 343 | * written */ |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 344 | xdr_decode_hyper((__be32 *)&arg_ch->rs_offset, &rs_offset); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 345 | svc_rdma_xdr_encode_array_chunk(res_ary, chunk_no, |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 346 | arg_ch->rs_handle, |
| 347 | arg_ch->rs_offset, |
| 348 | write_len); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 349 | chunk_off = 0; |
| 350 | while (write_len) { |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 351 | ret = send_write(xprt, rqstp, |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 352 | be32_to_cpu(arg_ch->rs_handle), |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 353 | rs_offset + chunk_off, |
| 354 | xdr_off, |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 355 | write_len, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 356 | vec); |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 357 | if (ret <= 0) |
| 358 | goto out_err; |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 359 | chunk_off += ret; |
| 360 | xdr_off += ret; |
| 361 | xfer_len -= ret; |
| 362 | write_len -= ret; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 363 | } |
| 364 | } |
| 365 | /* Update the req with the number of chunks actually used */ |
| 366 | svc_rdma_xdr_encode_write_list(rdma_resp, chunk_no); |
| 367 | |
Chuck Lever | cf570a9 | 2016-03-01 13:05:45 -0500 | [diff] [blame] | 368 | return rqstp->rq_res.page_len; |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 369 | |
| 370 | out_err: |
| 371 | pr_err("svcrdma: failed to send write chunks, rc=%d\n", ret); |
| 372 | return -EIO; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 373 | } |
| 374 | |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 375 | noinline |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 376 | static int send_reply_chunks(struct svcxprt_rdma *xprt, |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 377 | struct rpcrdma_write_array *rp_ary, |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 378 | struct rpcrdma_msg *rdma_resp, |
| 379 | struct svc_rqst *rqstp, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 380 | struct svc_rdma_req_map *vec) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 381 | { |
| 382 | u32 xfer_len = rqstp->rq_res.len; |
| 383 | int write_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 384 | u32 xdr_off; |
| 385 | int chunk_no; |
| 386 | int chunk_off; |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 387 | int nchunks; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 388 | struct rpcrdma_segment *ch; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 389 | struct rpcrdma_write_array *res_ary; |
| 390 | int ret; |
| 391 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 392 | /* XXX: need to fix when reply lists occur with read-list and or |
| 393 | * write-list */ |
| 394 | res_ary = (struct rpcrdma_write_array *) |
| 395 | &rdma_resp->rm_body.rm_chunks[2]; |
| 396 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 397 | /* xdr offset starts at RPC message */ |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 398 | nchunks = be32_to_cpu(rp_ary->wc_nchunks); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 399 | for (xdr_off = 0, chunk_no = 0; |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 400 | xfer_len && chunk_no < nchunks; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 401 | chunk_no++) { |
| 402 | u64 rs_offset; |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 403 | ch = &rp_ary->wc_array[chunk_no].wc_target; |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 404 | write_len = min(xfer_len, be32_to_cpu(ch->rs_length)); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 405 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 406 | /* Prepare the reply chunk given the length actually |
| 407 | * written */ |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 408 | xdr_decode_hyper((__be32 *)&ch->rs_offset, &rs_offset); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 409 | svc_rdma_xdr_encode_array_chunk(res_ary, chunk_no, |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 410 | ch->rs_handle, ch->rs_offset, |
| 411 | write_len); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 412 | chunk_off = 0; |
| 413 | while (write_len) { |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 414 | ret = send_write(xprt, rqstp, |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 415 | be32_to_cpu(ch->rs_handle), |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 416 | rs_offset + chunk_off, |
| 417 | xdr_off, |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 418 | write_len, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 419 | vec); |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 420 | if (ret <= 0) |
| 421 | goto out_err; |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 422 | chunk_off += ret; |
| 423 | xdr_off += ret; |
| 424 | xfer_len -= ret; |
| 425 | write_len -= ret; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 426 | } |
| 427 | } |
| 428 | /* Update the req with the number of chunks actually used */ |
| 429 | svc_rdma_xdr_encode_reply_array(res_ary, chunk_no); |
| 430 | |
| 431 | return rqstp->rq_res.len; |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 432 | |
| 433 | out_err: |
| 434 | pr_err("svcrdma: failed to send reply chunks, rc=%d\n", ret); |
| 435 | return -EIO; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 436 | } |
| 437 | |
| 438 | /* This function prepares the portion of the RPCRDMA message to be |
| 439 | * sent in the RDMA_SEND. This function is called after data sent via |
| 440 | * RDMA has already been transmitted. There are three cases: |
| 441 | * - The RPCRDMA header, RPC header, and payload are all sent in a |
| 442 | * single RDMA_SEND. This is the "inline" case. |
| 443 | * - The RPCRDMA header and some portion of the RPC header and data |
| 444 | * are sent via this RDMA_SEND and another portion of the data is |
| 445 | * sent via RDMA. |
| 446 | * - The RPCRDMA header [NOMSG] is sent in this RDMA_SEND and the RPC |
| 447 | * header and data are all transmitted via RDMA. |
| 448 | * In all three cases, this function prepares the RPCRDMA header in |
| 449 | * sge[0], the 'type' parameter indicates the type to place in the |
| 450 | * RPCRDMA header, and the 'byte_count' field indicates how much of |
Tom Tucker | b432e6b | 2010-10-12 15:33:52 -0500 | [diff] [blame] | 451 | * the XDR to include in this RDMA_SEND. NB: The offset of the payload |
| 452 | * to send is zero in the XDR. |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 453 | */ |
| 454 | static int send_reply(struct svcxprt_rdma *rdma, |
| 455 | struct svc_rqst *rqstp, |
| 456 | struct page *page, |
| 457 | struct rpcrdma_msg *rdma_resp, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 458 | struct svc_rdma_req_map *vec, |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 459 | int byte_count, |
| 460 | u32 inv_rkey) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 461 | { |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame] | 462 | struct svc_rdma_op_ctxt *ctxt; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 463 | struct ib_send_wr send_wr; |
Chuck Lever | 9d11b51 | 2015-07-09 16:45:18 -0400 | [diff] [blame] | 464 | u32 xdr_off; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 465 | int sge_no; |
| 466 | int sge_bytes; |
| 467 | int page_no; |
J. Bruce Fields | afc5940 | 2012-12-10 18:01:37 -0500 | [diff] [blame] | 468 | int pages; |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame] | 469 | int ret = -EIO; |
Tom Tucker | 0e7f011 | 2008-04-23 16:49:54 -0500 | [diff] [blame] | 470 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 471 | /* Prepare the context */ |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame] | 472 | ctxt = svc_rdma_get_context(rdma); |
| 473 | ctxt->direction = DMA_TO_DEVICE; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 474 | ctxt->pages[0] = page; |
| 475 | ctxt->count = 1; |
| 476 | |
| 477 | /* Prepare the SGE for the RPCRDMA Header */ |
Christoph Hellwig | 5fe1043 | 2016-01-07 23:53:41 -0800 | [diff] [blame] | 478 | ctxt->sge[0].lkey = rdma->sc_pd->local_dma_lkey; |
Chuck Lever | cbaf580 | 2017-02-07 11:58:15 -0500 | [diff] [blame] | 479 | ctxt->sge[0].length = |
| 480 | svc_rdma_xdr_get_reply_hdr_len((__be32 *)rdma_resp); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 481 | ctxt->sge[0].addr = |
Tom Tucker | b432e6b | 2010-10-12 15:33:52 -0500 | [diff] [blame] | 482 | ib_dma_map_page(rdma->sc_cm_id->device, page, 0, |
| 483 | ctxt->sge[0].length, DMA_TO_DEVICE); |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 484 | if (ib_dma_mapping_error(rdma->sc_cm_id->device, ctxt->sge[0].addr)) |
| 485 | goto err; |
Chuck Lever | cace564 | 2016-09-13 10:52:50 -0400 | [diff] [blame] | 486 | svc_rdma_count_mappings(rdma, ctxt); |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 487 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 488 | ctxt->direction = DMA_TO_DEVICE; |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 489 | |
Tom Tucker | b432e6b | 2010-10-12 15:33:52 -0500 | [diff] [blame] | 490 | /* Map the payload indicated by 'byte_count' */ |
Chuck Lever | 9d11b51 | 2015-07-09 16:45:18 -0400 | [diff] [blame] | 491 | xdr_off = 0; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 492 | for (sge_no = 1; byte_count && sge_no < vec->count; sge_no++) { |
| 493 | sge_bytes = min_t(size_t, vec->sge[sge_no].iov_len, byte_count); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 494 | byte_count -= sge_bytes; |
Steve Wise | 0bf4828 | 2014-05-28 15:12:01 -0500 | [diff] [blame] | 495 | ctxt->sge[sge_no].addr = |
| 496 | dma_map_xdr(rdma, &rqstp->rq_res, xdr_off, |
| 497 | sge_bytes, DMA_TO_DEVICE); |
| 498 | xdr_off += sge_bytes; |
| 499 | if (ib_dma_mapping_error(rdma->sc_cm_id->device, |
| 500 | ctxt->sge[sge_no].addr)) |
| 501 | goto err; |
Chuck Lever | cace564 | 2016-09-13 10:52:50 -0400 | [diff] [blame] | 502 | svc_rdma_count_mappings(rdma, ctxt); |
Christoph Hellwig | 5fe1043 | 2016-01-07 23:53:41 -0800 | [diff] [blame] | 503 | ctxt->sge[sge_no].lkey = rdma->sc_pd->local_dma_lkey; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 504 | ctxt->sge[sge_no].length = sge_bytes; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 505 | } |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 506 | if (byte_count != 0) { |
| 507 | pr_err("svcrdma: Could not map %d bytes\n", byte_count); |
| 508 | goto err; |
| 509 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 510 | |
| 511 | /* Save all respages in the ctxt and remove them from the |
| 512 | * respages array. They are our pages until the I/O |
| 513 | * completes. |
| 514 | */ |
J. Bruce Fields | afc5940 | 2012-12-10 18:01:37 -0500 | [diff] [blame] | 515 | pages = rqstp->rq_next_page - rqstp->rq_respages; |
| 516 | for (page_no = 0; page_no < pages; page_no++) { |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 517 | ctxt->pages[page_no+1] = rqstp->rq_respages[page_no]; |
| 518 | ctxt->count++; |
| 519 | rqstp->rq_respages[page_no] = NULL; |
| 520 | } |
Tom Tucker | 7e4359e | 2014-03-25 15:14:57 -0500 | [diff] [blame] | 521 | rqstp->rq_next_page = rqstp->rq_respages + 1; |
Steve Wise | 0bf4828 | 2014-05-28 15:12:01 -0500 | [diff] [blame] | 522 | |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 523 | if (sge_no > rdma->sc_max_sge) { |
| 524 | pr_err("svcrdma: Too many sges (%d)\n", sge_no); |
| 525 | goto err; |
| 526 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 527 | memset(&send_wr, 0, sizeof send_wr); |
Chuck Lever | be99bb1 | 2016-03-01 13:07:22 -0500 | [diff] [blame] | 528 | ctxt->cqe.done = svc_rdma_wc_send; |
| 529 | send_wr.wr_cqe = &ctxt->cqe; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 530 | send_wr.sg_list = ctxt->sge; |
| 531 | send_wr.num_sge = sge_no; |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 532 | if (inv_rkey) { |
| 533 | send_wr.opcode = IB_WR_SEND_WITH_INV; |
| 534 | send_wr.ex.invalidate_rkey = inv_rkey; |
| 535 | } else |
| 536 | send_wr.opcode = IB_WR_SEND; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 537 | send_wr.send_flags = IB_SEND_SIGNALED; |
| 538 | |
| 539 | ret = svc_rdma_send(rdma, &send_wr); |
| 540 | if (ret) |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 541 | goto err; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 542 | |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 543 | return 0; |
| 544 | |
| 545 | err: |
Steve Wise | 21515e4 | 2009-04-29 14:14:00 -0500 | [diff] [blame] | 546 | svc_rdma_unmap_dma(ctxt); |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 547 | svc_rdma_put_context(ctxt, 1); |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame] | 548 | return ret; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 549 | } |
| 550 | |
| 551 | void svc_rdma_prep_reply_hdr(struct svc_rqst *rqstp) |
| 552 | { |
| 553 | } |
| 554 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 555 | int svc_rdma_sendto(struct svc_rqst *rqstp) |
| 556 | { |
| 557 | struct svc_xprt *xprt = rqstp->rq_xprt; |
| 558 | struct svcxprt_rdma *rdma = |
| 559 | container_of(xprt, struct svcxprt_rdma, sc_xprt); |
| 560 | struct rpcrdma_msg *rdma_argp; |
| 561 | struct rpcrdma_msg *rdma_resp; |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 562 | struct rpcrdma_write_array *wr_ary, *rp_ary; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 563 | int ret; |
| 564 | int inline_bytes; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 565 | struct page *res_page; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 566 | struct svc_rdma_req_map *vec; |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 567 | u32 inv_rkey; |
Chuck Lever | 98fc21d | 2017-02-07 11:58:23 -0500 | [diff] [blame^] | 568 | __be32 *p; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 569 | |
| 570 | dprintk("svcrdma: sending response for rqstp=%p\n", rqstp); |
| 571 | |
Chuck Lever | e5523bd | 2015-01-13 11:03:11 -0500 | [diff] [blame] | 572 | /* Get the RDMA request header. The receive logic always |
| 573 | * places this at the start of page 0. |
| 574 | */ |
| 575 | rdma_argp = page_address(rqstp->rq_pages[0]); |
Chuck Lever | 5fdca65 | 2016-11-29 11:04:42 -0500 | [diff] [blame] | 576 | svc_rdma_get_write_arrays(rdma_argp, &wr_ary, &rp_ary); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 577 | |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 578 | inv_rkey = 0; |
| 579 | if (rdma->sc_snd_w_inv) |
| 580 | inv_rkey = svc_rdma_get_inv_rkey(rdma_argp, wr_ary, rp_ary); |
| 581 | |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 582 | /* Build an req vec for the XDR */ |
Chuck Lever | 2fe81b2 | 2016-01-07 14:49:20 -0500 | [diff] [blame] | 583 | vec = svc_rdma_get_req_map(rdma); |
Chuck Lever | f6763c2 | 2016-03-01 13:05:54 -0500 | [diff] [blame] | 584 | ret = svc_rdma_map_xdr(rdma, &rqstp->rq_res, vec, wr_ary != NULL); |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 585 | if (ret) |
| 586 | goto err0; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 587 | inline_bytes = rqstp->rq_res.len; |
| 588 | |
Chuck Lever | e4eb42c | 2016-11-29 11:04:50 -0500 | [diff] [blame] | 589 | /* Create the RDMA response header. xprt->xpt_mutex, |
| 590 | * acquired in svc_send(), serializes RPC replies. The |
| 591 | * code path below that inserts the credit grant value |
| 592 | * into each transport header runs only inside this |
| 593 | * critical section. |
| 594 | */ |
Chuck Lever | 78da2b3 | 2016-01-07 14:49:45 -0500 | [diff] [blame] | 595 | ret = -ENOMEM; |
| 596 | res_page = alloc_page(GFP_KERNEL); |
| 597 | if (!res_page) |
| 598 | goto err0; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 599 | rdma_resp = page_address(res_page); |
Chuck Lever | 98fc21d | 2017-02-07 11:58:23 -0500 | [diff] [blame^] | 600 | |
| 601 | p = &rdma_resp->rm_xid; |
| 602 | *p++ = rdma_argp->rm_xid; |
| 603 | *p++ = rdma_argp->rm_vers; |
| 604 | *p++ = rdma->sc_fc_credits; |
| 605 | *p++ = rp_ary ? rdma_nomsg : rdma_msg; |
| 606 | |
| 607 | /* Start with empty chunks */ |
| 608 | *p++ = xdr_zero; |
| 609 | *p++ = xdr_zero; |
| 610 | *p = xdr_zero; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 611 | |
| 612 | /* Send any write-chunk data and build resp write-list */ |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 613 | if (wr_ary) { |
| 614 | ret = send_write_chunks(rdma, wr_ary, rdma_resp, rqstp, vec); |
| 615 | if (ret < 0) |
| 616 | goto err1; |
Chuck Lever | cf570a9 | 2016-03-01 13:05:45 -0500 | [diff] [blame] | 617 | inline_bytes -= ret + xdr_padsize(ret); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 618 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 619 | |
| 620 | /* Send any reply-list data and update resp reply-list */ |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 621 | if (rp_ary) { |
| 622 | ret = send_reply_chunks(rdma, rp_ary, rdma_resp, rqstp, vec); |
| 623 | if (ret < 0) |
| 624 | goto err1; |
| 625 | inline_bytes -= ret; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 626 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 627 | |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame] | 628 | /* Post a fresh Receive buffer _before_ sending the reply */ |
| 629 | ret = svc_rdma_post_recv(rdma, GFP_KERNEL); |
| 630 | if (ret) |
| 631 | goto err1; |
| 632 | |
| 633 | ret = send_reply(rdma, rqstp, res_page, rdma_resp, vec, |
Chuck Lever | 25d55296 | 2016-09-13 10:53:23 -0400 | [diff] [blame] | 634 | inline_bytes, inv_rkey); |
Chuck Lever | 3e1eeb9 | 2016-03-01 13:06:11 -0500 | [diff] [blame] | 635 | if (ret < 0) |
Chuck Lever | 9995237 | 2016-09-13 10:52:59 -0400 | [diff] [blame] | 636 | goto err0; |
Chuck Lever | 3e1eeb9 | 2016-03-01 13:06:11 -0500 | [diff] [blame] | 637 | |
Chuck Lever | 2fe81b2 | 2016-01-07 14:49:20 -0500 | [diff] [blame] | 638 | svc_rdma_put_req_map(rdma, vec); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 639 | dprintk("svcrdma: send_reply returns %d\n", ret); |
| 640 | return ret; |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 641 | |
| 642 | err1: |
| 643 | put_page(res_page); |
| 644 | err0: |
Chuck Lever | 2fe81b2 | 2016-01-07 14:49:20 -0500 | [diff] [blame] | 645 | svc_rdma_put_req_map(rdma, vec); |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame] | 646 | pr_err("svcrdma: Could not send reply, err=%d. Closing transport.\n", |
| 647 | ret); |
Chuck Lever | 3e1eeb9 | 2016-03-01 13:06:11 -0500 | [diff] [blame] | 648 | set_bit(XPT_CLOSE, &rdma->sc_xprt.xpt_flags); |
| 649 | return -ENOTCONN; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 650 | } |
Chuck Lever | a6081b8 | 2016-03-01 13:06:38 -0500 | [diff] [blame] | 651 | |
| 652 | void svc_rdma_send_error(struct svcxprt_rdma *xprt, struct rpcrdma_msg *rmsgp, |
| 653 | int status) |
| 654 | { |
| 655 | struct ib_send_wr err_wr; |
| 656 | struct page *p; |
| 657 | struct svc_rdma_op_ctxt *ctxt; |
| 658 | enum rpcrdma_errcode err; |
| 659 | __be32 *va; |
| 660 | int length; |
| 661 | int ret; |
| 662 | |
| 663 | ret = svc_rdma_repost_recv(xprt, GFP_KERNEL); |
| 664 | if (ret) |
| 665 | return; |
| 666 | |
| 667 | p = alloc_page(GFP_KERNEL); |
| 668 | if (!p) |
| 669 | return; |
| 670 | va = page_address(p); |
| 671 | |
| 672 | /* XDR encode an error reply */ |
| 673 | err = ERR_CHUNK; |
| 674 | if (status == -EPROTONOSUPPORT) |
| 675 | err = ERR_VERS; |
| 676 | length = svc_rdma_xdr_encode_error(xprt, rmsgp, err, va); |
| 677 | |
| 678 | ctxt = svc_rdma_get_context(xprt); |
| 679 | ctxt->direction = DMA_TO_DEVICE; |
| 680 | ctxt->count = 1; |
| 681 | ctxt->pages[0] = p; |
| 682 | |
| 683 | /* Prepare SGE for local address */ |
| 684 | ctxt->sge[0].lkey = xprt->sc_pd->local_dma_lkey; |
| 685 | ctxt->sge[0].length = length; |
| 686 | ctxt->sge[0].addr = ib_dma_map_page(xprt->sc_cm_id->device, |
| 687 | p, 0, length, DMA_TO_DEVICE); |
| 688 | if (ib_dma_mapping_error(xprt->sc_cm_id->device, ctxt->sge[0].addr)) { |
| 689 | dprintk("svcrdma: Error mapping buffer for protocol error\n"); |
| 690 | svc_rdma_put_context(ctxt, 1); |
| 691 | return; |
| 692 | } |
Chuck Lever | cace564 | 2016-09-13 10:52:50 -0400 | [diff] [blame] | 693 | svc_rdma_count_mappings(xprt, ctxt); |
Chuck Lever | a6081b8 | 2016-03-01 13:06:38 -0500 | [diff] [blame] | 694 | |
| 695 | /* Prepare SEND WR */ |
| 696 | memset(&err_wr, 0, sizeof(err_wr)); |
Chuck Lever | be99bb1 | 2016-03-01 13:07:22 -0500 | [diff] [blame] | 697 | ctxt->cqe.done = svc_rdma_wc_send; |
| 698 | err_wr.wr_cqe = &ctxt->cqe; |
Chuck Lever | a6081b8 | 2016-03-01 13:06:38 -0500 | [diff] [blame] | 699 | err_wr.sg_list = ctxt->sge; |
| 700 | err_wr.num_sge = 1; |
| 701 | err_wr.opcode = IB_WR_SEND; |
| 702 | err_wr.send_flags = IB_SEND_SIGNALED; |
| 703 | |
| 704 | /* Post It */ |
| 705 | ret = svc_rdma_send(xprt, &err_wr); |
| 706 | if (ret) { |
| 707 | dprintk("svcrdma: Error %d posting send for protocol error\n", |
| 708 | ret); |
| 709 | svc_rdma_unmap_dma(ctxt); |
| 710 | svc_rdma_put_context(ctxt, 1); |
| 711 | } |
| 712 | } |