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 | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 156 | /* Returns the address of the first read chunk or <nul> if no read chunk |
| 157 | * is present |
| 158 | */ |
| 159 | struct rpcrdma_read_chunk * |
| 160 | svc_rdma_get_read_chunk(struct rpcrdma_msg *rmsgp) |
| 161 | { |
| 162 | struct rpcrdma_read_chunk *ch = |
| 163 | (struct rpcrdma_read_chunk *)&rmsgp->rm_body.rm_chunks[0]; |
| 164 | |
| 165 | if (ch->rc_discrim == xdr_zero) |
| 166 | return NULL; |
| 167 | return ch; |
| 168 | } |
| 169 | |
| 170 | /* Returns the address of the first read write array element or <nul> |
| 171 | * if no write array list is present |
| 172 | */ |
| 173 | static struct rpcrdma_write_array * |
| 174 | svc_rdma_get_write_array(struct rpcrdma_msg *rmsgp) |
| 175 | { |
| 176 | if (rmsgp->rm_body.rm_chunks[0] != xdr_zero || |
| 177 | rmsgp->rm_body.rm_chunks[1] == xdr_zero) |
| 178 | return NULL; |
| 179 | return (struct rpcrdma_write_array *)&rmsgp->rm_body.rm_chunks[1]; |
| 180 | } |
| 181 | |
| 182 | /* Returns the address of the first reply array element or <nul> if no |
| 183 | * reply array is present |
| 184 | */ |
| 185 | static struct rpcrdma_write_array * |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 186 | svc_rdma_get_reply_array(struct rpcrdma_msg *rmsgp, |
| 187 | struct rpcrdma_write_array *wr_ary) |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 188 | { |
| 189 | struct rpcrdma_read_chunk *rch; |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 190 | struct rpcrdma_write_array *rp_ary; |
| 191 | |
| 192 | /* XXX: Need to fix when reply chunk may occur with read list |
| 193 | * and/or write list. |
| 194 | */ |
| 195 | if (rmsgp->rm_body.rm_chunks[0] != xdr_zero || |
| 196 | rmsgp->rm_body.rm_chunks[1] != xdr_zero) |
| 197 | return NULL; |
| 198 | |
| 199 | rch = svc_rdma_get_read_chunk(rmsgp); |
| 200 | if (rch) { |
| 201 | while (rch->rc_discrim != xdr_zero) |
| 202 | rch++; |
| 203 | |
| 204 | /* The reply chunk follows an empty write array located |
| 205 | * at 'rc_position' here. The reply array is at rc_target. |
| 206 | */ |
| 207 | rp_ary = (struct rpcrdma_write_array *)&rch->rc_target; |
| 208 | goto found_it; |
| 209 | } |
| 210 | |
Chuck Lever | 10dc451 | 2015-07-09 16:45:28 -0400 | [diff] [blame] | 211 | if (wr_ary) { |
| 212 | int chunk = be32_to_cpu(wr_ary->wc_nchunks); |
| 213 | |
| 214 | rp_ary = (struct rpcrdma_write_array *) |
| 215 | &wr_ary->wc_array[chunk].wc_target.rs_length; |
| 216 | goto found_it; |
| 217 | } |
| 218 | |
| 219 | /* No read list, no write list */ |
| 220 | rp_ary = (struct rpcrdma_write_array *)&rmsgp->rm_body.rm_chunks[2]; |
| 221 | |
| 222 | found_it: |
| 223 | if (rp_ary->wc_discrim == xdr_zero) |
| 224 | return NULL; |
| 225 | return rp_ary; |
| 226 | } |
| 227 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 228 | /* Assumptions: |
| 229 | * - The specified write_len can be represented in sc_max_sge * PAGE_SIZE |
| 230 | */ |
| 231 | static int send_write(struct svcxprt_rdma *xprt, struct svc_rqst *rqstp, |
| 232 | u32 rmr, u64 to, |
| 233 | u32 xdr_off, int write_len, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 234 | struct svc_rdma_req_map *vec) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 235 | { |
Christoph Hellwig | e622f2f | 2015-10-08 09:16:33 +0100 | [diff] [blame] | 236 | struct ib_rdma_wr write_wr; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 237 | struct ib_sge *sge; |
| 238 | int xdr_sge_no; |
| 239 | int sge_no; |
| 240 | int sge_bytes; |
| 241 | int sge_off; |
| 242 | int bc; |
| 243 | struct svc_rdma_op_ctxt *ctxt; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 244 | |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 245 | if (vec->count > RPCSVC_MAXPAGES) { |
| 246 | pr_err("svcrdma: Too many pages (%lu)\n", vec->count); |
| 247 | return -EIO; |
| 248 | } |
| 249 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 250 | dprintk("svcrdma: RDMA_WRITE rmr=%x, to=%llx, xdr_off=%d, " |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 251 | "write_len=%d, vec->sge=%p, vec->count=%lu\n", |
Roland Dreier | bb50c80 | 2008-02-08 16:02:04 -0800 | [diff] [blame] | 252 | rmr, (unsigned long long)to, xdr_off, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 253 | write_len, vec->sge, vec->count); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 254 | |
| 255 | ctxt = svc_rdma_get_context(xprt); |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 256 | ctxt->direction = DMA_TO_DEVICE; |
| 257 | sge = ctxt->sge; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 258 | |
| 259 | /* Find the SGE associated with xdr_off */ |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 260 | 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] | 261 | xdr_sge_no++) { |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 262 | if (vec->sge[xdr_sge_no].iov_len > bc) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 263 | break; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 264 | bc -= vec->sge[xdr_sge_no].iov_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 265 | } |
| 266 | |
| 267 | sge_off = bc; |
| 268 | bc = write_len; |
| 269 | sge_no = 0; |
| 270 | |
| 271 | /* Copy the remaining SGE */ |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 272 | while (bc != 0) { |
| 273 | sge_bytes = min_t(size_t, |
| 274 | bc, vec->sge[xdr_sge_no].iov_len-sge_off); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 275 | sge[sge_no].length = sge_bytes; |
Steve Wise | 0bf4828 | 2014-05-28 15:12:01 -0500 | [diff] [blame] | 276 | sge[sge_no].addr = |
| 277 | dma_map_xdr(xprt, &rqstp->rq_res, xdr_off, |
| 278 | sge_bytes, DMA_TO_DEVICE); |
| 279 | xdr_off += sge_bytes; |
| 280 | if (ib_dma_mapping_error(xprt->sc_cm_id->device, |
| 281 | sge[sge_no].addr)) |
| 282 | goto err; |
| 283 | atomic_inc(&xprt->sc_dma_used); |
Christoph Hellwig | 5fe1043 | 2016-01-07 23:53:41 -0800 | [diff] [blame] | 284 | sge[sge_no].lkey = xprt->sc_pd->local_dma_lkey; |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 285 | ctxt->count++; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 286 | sge_off = 0; |
| 287 | sge_no++; |
| 288 | xdr_sge_no++; |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 289 | if (xdr_sge_no > vec->count) { |
| 290 | pr_err("svcrdma: Too many sges (%d)\n", xdr_sge_no); |
| 291 | goto err; |
| 292 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 293 | bc -= sge_bytes; |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 294 | if (sge_no == xprt->sc_max_sge) |
| 295 | break; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 296 | } |
| 297 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 298 | /* Prepare WRITE WR */ |
| 299 | memset(&write_wr, 0, sizeof write_wr); |
Chuck Lever | be99bb1 | 2016-03-01 13:07:22 -0500 | [diff] [blame] | 300 | ctxt->cqe.done = svc_rdma_wc_write; |
| 301 | write_wr.wr.wr_cqe = &ctxt->cqe; |
Christoph Hellwig | e622f2f | 2015-10-08 09:16:33 +0100 | [diff] [blame] | 302 | write_wr.wr.sg_list = &sge[0]; |
| 303 | write_wr.wr.num_sge = sge_no; |
| 304 | write_wr.wr.opcode = IB_WR_RDMA_WRITE; |
| 305 | write_wr.wr.send_flags = IB_SEND_SIGNALED; |
| 306 | write_wr.rkey = rmr; |
| 307 | write_wr.remote_addr = to; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 308 | |
| 309 | /* Post It */ |
| 310 | atomic_inc(&rdma_stat_write); |
Christoph Hellwig | e622f2f | 2015-10-08 09:16:33 +0100 | [diff] [blame] | 311 | if (svc_rdma_send(xprt, &write_wr.wr)) |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 312 | goto err; |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 313 | return write_len - bc; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 314 | err: |
Tom Tucker | 4a84386 | 2010-10-12 15:33:57 -0500 | [diff] [blame] | 315 | svc_rdma_unmap_dma(ctxt); |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 316 | svc_rdma_put_context(ctxt, 0); |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 317 | return -EIO; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 318 | } |
| 319 | |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 320 | noinline |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 321 | static int send_write_chunks(struct svcxprt_rdma *xprt, |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 322 | struct rpcrdma_write_array *wr_ary, |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 323 | struct rpcrdma_msg *rdma_resp, |
| 324 | struct svc_rqst *rqstp, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 325 | struct svc_rdma_req_map *vec) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 326 | { |
Chuck Lever | cf570a9 | 2016-03-01 13:05:45 -0500 | [diff] [blame] | 327 | u32 xfer_len = rqstp->rq_res.page_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 328 | int write_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 329 | u32 xdr_off; |
| 330 | int chunk_off; |
| 331 | int chunk_no; |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 332 | int nchunks; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 333 | struct rpcrdma_write_array *res_ary; |
| 334 | int ret; |
| 335 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 336 | res_ary = (struct rpcrdma_write_array *) |
| 337 | &rdma_resp->rm_body.rm_chunks[1]; |
| 338 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 339 | /* Write chunks start at the pagelist */ |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 340 | nchunks = be32_to_cpu(wr_ary->wc_nchunks); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 341 | 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] | 342 | xfer_len && chunk_no < nchunks; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 343 | chunk_no++) { |
| 344 | struct rpcrdma_segment *arg_ch; |
| 345 | u64 rs_offset; |
| 346 | |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 347 | arg_ch = &wr_ary->wc_array[chunk_no].wc_target; |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 348 | write_len = min(xfer_len, be32_to_cpu(arg_ch->rs_length)); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 349 | |
| 350 | /* Prepare the response chunk given the length actually |
| 351 | * written */ |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 352 | xdr_decode_hyper((__be32 *)&arg_ch->rs_offset, &rs_offset); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 353 | svc_rdma_xdr_encode_array_chunk(res_ary, chunk_no, |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 354 | arg_ch->rs_handle, |
| 355 | arg_ch->rs_offset, |
| 356 | write_len); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 357 | chunk_off = 0; |
| 358 | while (write_len) { |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 359 | ret = send_write(xprt, rqstp, |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 360 | be32_to_cpu(arg_ch->rs_handle), |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 361 | rs_offset + chunk_off, |
| 362 | xdr_off, |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 363 | write_len, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 364 | vec); |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 365 | if (ret <= 0) |
| 366 | goto out_err; |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 367 | chunk_off += ret; |
| 368 | xdr_off += ret; |
| 369 | xfer_len -= ret; |
| 370 | write_len -= ret; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 371 | } |
| 372 | } |
| 373 | /* Update the req with the number of chunks actually used */ |
| 374 | svc_rdma_xdr_encode_write_list(rdma_resp, chunk_no); |
| 375 | |
Chuck Lever | cf570a9 | 2016-03-01 13:05:45 -0500 | [diff] [blame] | 376 | return rqstp->rq_res.page_len; |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 377 | |
| 378 | out_err: |
| 379 | pr_err("svcrdma: failed to send write chunks, rc=%d\n", ret); |
| 380 | return -EIO; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 381 | } |
| 382 | |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 383 | noinline |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 384 | static int send_reply_chunks(struct svcxprt_rdma *xprt, |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 385 | struct rpcrdma_write_array *rp_ary, |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 386 | struct rpcrdma_msg *rdma_resp, |
| 387 | struct svc_rqst *rqstp, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 388 | struct svc_rdma_req_map *vec) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 389 | { |
| 390 | u32 xfer_len = rqstp->rq_res.len; |
| 391 | int write_len; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 392 | u32 xdr_off; |
| 393 | int chunk_no; |
| 394 | int chunk_off; |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 395 | int nchunks; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 396 | struct rpcrdma_segment *ch; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 397 | struct rpcrdma_write_array *res_ary; |
| 398 | int ret; |
| 399 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 400 | /* XXX: need to fix when reply lists occur with read-list and or |
| 401 | * write-list */ |
| 402 | res_ary = (struct rpcrdma_write_array *) |
| 403 | &rdma_resp->rm_body.rm_chunks[2]; |
| 404 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 405 | /* xdr offset starts at RPC message */ |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 406 | nchunks = be32_to_cpu(rp_ary->wc_nchunks); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 407 | for (xdr_off = 0, chunk_no = 0; |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 408 | xfer_len && chunk_no < nchunks; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 409 | chunk_no++) { |
| 410 | u64 rs_offset; |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 411 | ch = &rp_ary->wc_array[chunk_no].wc_target; |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 412 | write_len = min(xfer_len, be32_to_cpu(ch->rs_length)); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 413 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 414 | /* Prepare the reply chunk given the length actually |
| 415 | * written */ |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 416 | xdr_decode_hyper((__be32 *)&ch->rs_offset, &rs_offset); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 417 | svc_rdma_xdr_encode_array_chunk(res_ary, chunk_no, |
Tom Tucker | cec56c8 | 2012-02-15 11:30:00 -0600 | [diff] [blame] | 418 | ch->rs_handle, ch->rs_offset, |
| 419 | write_len); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 420 | chunk_off = 0; |
| 421 | while (write_len) { |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 422 | ret = send_write(xprt, rqstp, |
Chuck Lever | 70747c2 | 2015-06-04 11:20:39 -0400 | [diff] [blame] | 423 | be32_to_cpu(ch->rs_handle), |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 424 | rs_offset + chunk_off, |
| 425 | xdr_off, |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 426 | write_len, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 427 | vec); |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 428 | if (ret <= 0) |
| 429 | goto out_err; |
Steve Wise | 2559429 | 2014-07-09 13:49:15 -0500 | [diff] [blame] | 430 | chunk_off += ret; |
| 431 | xdr_off += ret; |
| 432 | xfer_len -= ret; |
| 433 | write_len -= ret; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 434 | } |
| 435 | } |
| 436 | /* Update the req with the number of chunks actually used */ |
| 437 | svc_rdma_xdr_encode_reply_array(res_ary, chunk_no); |
| 438 | |
| 439 | return rqstp->rq_res.len; |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 440 | |
| 441 | out_err: |
| 442 | pr_err("svcrdma: failed to send reply chunks, rc=%d\n", ret); |
| 443 | return -EIO; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 444 | } |
| 445 | |
| 446 | /* This function prepares the portion of the RPCRDMA message to be |
| 447 | * sent in the RDMA_SEND. This function is called after data sent via |
| 448 | * RDMA has already been transmitted. There are three cases: |
| 449 | * - The RPCRDMA header, RPC header, and payload are all sent in a |
| 450 | * single RDMA_SEND. This is the "inline" case. |
| 451 | * - The RPCRDMA header and some portion of the RPC header and data |
| 452 | * are sent via this RDMA_SEND and another portion of the data is |
| 453 | * sent via RDMA. |
| 454 | * - The RPCRDMA header [NOMSG] is sent in this RDMA_SEND and the RPC |
| 455 | * header and data are all transmitted via RDMA. |
| 456 | * In all three cases, this function prepares the RPCRDMA header in |
| 457 | * sge[0], the 'type' parameter indicates the type to place in the |
| 458 | * RPCRDMA header, and the 'byte_count' field indicates how much of |
Tom Tucker | b432e6b | 2010-10-12 15:33:52 -0500 | [diff] [blame] | 459 | * the XDR to include in this RDMA_SEND. NB: The offset of the payload |
| 460 | * to send is zero in the XDR. |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 461 | */ |
| 462 | static int send_reply(struct svcxprt_rdma *rdma, |
| 463 | struct svc_rqst *rqstp, |
| 464 | struct page *page, |
| 465 | struct rpcrdma_msg *rdma_resp, |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 466 | struct svc_rdma_req_map *vec, |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 467 | int byte_count) |
| 468 | { |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame^] | 469 | struct svc_rdma_op_ctxt *ctxt; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 470 | struct ib_send_wr send_wr; |
Chuck Lever | 9d11b51 | 2015-07-09 16:45:18 -0400 | [diff] [blame] | 471 | u32 xdr_off; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 472 | int sge_no; |
| 473 | int sge_bytes; |
| 474 | int page_no; |
J. Bruce Fields | afc5940 | 2012-12-10 18:01:37 -0500 | [diff] [blame] | 475 | int pages; |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame^] | 476 | int ret = -EIO; |
Tom Tucker | 0e7f011 | 2008-04-23 16:49:54 -0500 | [diff] [blame] | 477 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 478 | /* Prepare the context */ |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame^] | 479 | ctxt = svc_rdma_get_context(rdma); |
| 480 | ctxt->direction = DMA_TO_DEVICE; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 481 | ctxt->pages[0] = page; |
| 482 | ctxt->count = 1; |
| 483 | |
| 484 | /* Prepare the SGE for the RPCRDMA Header */ |
Christoph Hellwig | 5fe1043 | 2016-01-07 23:53:41 -0800 | [diff] [blame] | 485 | ctxt->sge[0].lkey = rdma->sc_pd->local_dma_lkey; |
Steve Wise | 98779be | 2009-05-14 16:34:28 -0500 | [diff] [blame] | 486 | ctxt->sge[0].length = svc_rdma_xdr_get_reply_hdr_len(rdma_resp); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 487 | ctxt->sge[0].addr = |
Tom Tucker | b432e6b | 2010-10-12 15:33:52 -0500 | [diff] [blame] | 488 | ib_dma_map_page(rdma->sc_cm_id->device, page, 0, |
| 489 | ctxt->sge[0].length, DMA_TO_DEVICE); |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 490 | if (ib_dma_mapping_error(rdma->sc_cm_id->device, ctxt->sge[0].addr)) |
| 491 | goto err; |
| 492 | atomic_inc(&rdma->sc_dma_used); |
| 493 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 494 | ctxt->direction = DMA_TO_DEVICE; |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 495 | |
Tom Tucker | b432e6b | 2010-10-12 15:33:52 -0500 | [diff] [blame] | 496 | /* Map the payload indicated by 'byte_count' */ |
Chuck Lever | 9d11b51 | 2015-07-09 16:45:18 -0400 | [diff] [blame] | 497 | xdr_off = 0; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 498 | for (sge_no = 1; byte_count && sge_no < vec->count; sge_no++) { |
| 499 | 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] | 500 | byte_count -= sge_bytes; |
Steve Wise | 0bf4828 | 2014-05-28 15:12:01 -0500 | [diff] [blame] | 501 | ctxt->sge[sge_no].addr = |
| 502 | dma_map_xdr(rdma, &rqstp->rq_res, xdr_off, |
| 503 | sge_bytes, DMA_TO_DEVICE); |
| 504 | xdr_off += sge_bytes; |
| 505 | if (ib_dma_mapping_error(rdma->sc_cm_id->device, |
| 506 | ctxt->sge[sge_no].addr)) |
| 507 | goto err; |
| 508 | atomic_inc(&rdma->sc_dma_used); |
Christoph Hellwig | 5fe1043 | 2016-01-07 23:53:41 -0800 | [diff] [blame] | 509 | ctxt->sge[sge_no].lkey = rdma->sc_pd->local_dma_lkey; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 510 | ctxt->sge[sge_no].length = sge_bytes; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 511 | } |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 512 | if (byte_count != 0) { |
| 513 | pr_err("svcrdma: Could not map %d bytes\n", byte_count); |
| 514 | goto err; |
| 515 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 516 | |
| 517 | /* Save all respages in the ctxt and remove them from the |
| 518 | * respages array. They are our pages until the I/O |
| 519 | * completes. |
| 520 | */ |
J. Bruce Fields | afc5940 | 2012-12-10 18:01:37 -0500 | [diff] [blame] | 521 | pages = rqstp->rq_next_page - rqstp->rq_respages; |
| 522 | for (page_no = 0; page_no < pages; page_no++) { |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 523 | ctxt->pages[page_no+1] = rqstp->rq_respages[page_no]; |
| 524 | ctxt->count++; |
| 525 | rqstp->rq_respages[page_no] = NULL; |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 526 | /* |
| 527 | * If there are more pages than SGE, terminate SGE |
| 528 | * list so that svc_rdma_unmap_dma doesn't attempt to |
| 529 | * unmap garbage. |
| 530 | */ |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 531 | if (page_no+1 >= sge_no) |
| 532 | ctxt->sge[page_no+1].length = 0; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 533 | } |
Tom Tucker | 7e4359e | 2014-03-25 15:14:57 -0500 | [diff] [blame] | 534 | rqstp->rq_next_page = rqstp->rq_respages + 1; |
Steve Wise | 0bf4828 | 2014-05-28 15:12:01 -0500 | [diff] [blame] | 535 | |
Chuck Lever | 9d11b51 | 2015-07-09 16:45:18 -0400 | [diff] [blame] | 536 | /* The loop above bumps sc_dma_used for each sge. The |
| 537 | * xdr_buf.tail gets a separate sge, but resides in the |
| 538 | * same page as xdr_buf.head. Don't count it twice. |
| 539 | */ |
| 540 | if (sge_no > ctxt->count) |
| 541 | atomic_dec(&rdma->sc_dma_used); |
| 542 | |
Chuck Lever | 3fe04ee | 2015-01-13 11:03:03 -0500 | [diff] [blame] | 543 | if (sge_no > rdma->sc_max_sge) { |
| 544 | pr_err("svcrdma: Too many sges (%d)\n", sge_no); |
| 545 | goto err; |
| 546 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 547 | memset(&send_wr, 0, sizeof send_wr); |
Chuck Lever | be99bb1 | 2016-03-01 13:07:22 -0500 | [diff] [blame] | 548 | ctxt->cqe.done = svc_rdma_wc_send; |
| 549 | send_wr.wr_cqe = &ctxt->cqe; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 550 | send_wr.sg_list = ctxt->sge; |
| 551 | send_wr.num_sge = sge_no; |
| 552 | send_wr.opcode = IB_WR_SEND; |
| 553 | send_wr.send_flags = IB_SEND_SIGNALED; |
| 554 | |
| 555 | ret = svc_rdma_send(rdma, &send_wr); |
| 556 | if (ret) |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 557 | goto err; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 558 | |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 559 | return 0; |
| 560 | |
| 561 | err: |
Steve Wise | 21515e4 | 2009-04-29 14:14:00 -0500 | [diff] [blame] | 562 | svc_rdma_unmap_dma(ctxt); |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 563 | svc_rdma_put_context(ctxt, 1); |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame^] | 564 | return ret; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 565 | } |
| 566 | |
| 567 | void svc_rdma_prep_reply_hdr(struct svc_rqst *rqstp) |
| 568 | { |
| 569 | } |
| 570 | |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 571 | int svc_rdma_sendto(struct svc_rqst *rqstp) |
| 572 | { |
| 573 | struct svc_xprt *xprt = rqstp->rq_xprt; |
| 574 | struct svcxprt_rdma *rdma = |
| 575 | container_of(xprt, struct svcxprt_rdma, sc_xprt); |
| 576 | struct rpcrdma_msg *rdma_argp; |
| 577 | struct rpcrdma_msg *rdma_resp; |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 578 | struct rpcrdma_write_array *wr_ary, *rp_ary; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 579 | enum rpcrdma_proc reply_type; |
| 580 | int ret; |
| 581 | int inline_bytes; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 582 | struct page *res_page; |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 583 | struct svc_rdma_req_map *vec; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 584 | |
| 585 | dprintk("svcrdma: sending response for rqstp=%p\n", rqstp); |
| 586 | |
Chuck Lever | e5523bd | 2015-01-13 11:03:11 -0500 | [diff] [blame] | 587 | /* Get the RDMA request header. The receive logic always |
| 588 | * places this at the start of page 0. |
| 589 | */ |
| 590 | rdma_argp = page_address(rqstp->rq_pages[0]); |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 591 | wr_ary = svc_rdma_get_write_array(rdma_argp); |
| 592 | rp_ary = svc_rdma_get_reply_array(rdma_argp, wr_ary); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 593 | |
Tom Tucker | 34d16e4 | 2008-07-02 14:56:13 -0500 | [diff] [blame] | 594 | /* Build an req vec for the XDR */ |
Chuck Lever | 2fe81b2 | 2016-01-07 14:49:20 -0500 | [diff] [blame] | 595 | vec = svc_rdma_get_req_map(rdma); |
Chuck Lever | f6763c2 | 2016-03-01 13:05:54 -0500 | [diff] [blame] | 596 | 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] | 597 | if (ret) |
| 598 | goto err0; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 599 | inline_bytes = rqstp->rq_res.len; |
| 600 | |
| 601 | /* Create the RDMA response header */ |
Chuck Lever | 78da2b3 | 2016-01-07 14:49:45 -0500 | [diff] [blame] | 602 | ret = -ENOMEM; |
| 603 | res_page = alloc_page(GFP_KERNEL); |
| 604 | if (!res_page) |
| 605 | goto err0; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 606 | rdma_resp = page_address(res_page); |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 607 | if (rp_ary) |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 608 | reply_type = RDMA_NOMSG; |
| 609 | else |
| 610 | reply_type = RDMA_MSG; |
| 611 | svc_rdma_xdr_encode_reply_header(rdma, rdma_argp, |
| 612 | rdma_resp, reply_type); |
| 613 | |
| 614 | /* Send any write-chunk data and build resp write-list */ |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 615 | if (wr_ary) { |
| 616 | ret = send_write_chunks(rdma, wr_ary, rdma_resp, rqstp, vec); |
| 617 | if (ret < 0) |
| 618 | goto err1; |
Chuck Lever | cf570a9 | 2016-03-01 13:05:45 -0500 | [diff] [blame] | 619 | inline_bytes -= ret + xdr_padsize(ret); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 620 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 621 | |
| 622 | /* Send any reply-list data and update resp reply-list */ |
Chuck Lever | 08ae4e7 | 2016-03-01 13:05:36 -0500 | [diff] [blame] | 623 | if (rp_ary) { |
| 624 | ret = send_reply_chunks(rdma, rp_ary, rdma_resp, rqstp, vec); |
| 625 | if (ret < 0) |
| 626 | goto err1; |
| 627 | inline_bytes -= ret; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 628 | } |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 629 | |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame^] | 630 | /* Post a fresh Receive buffer _before_ sending the reply */ |
| 631 | ret = svc_rdma_post_recv(rdma, GFP_KERNEL); |
| 632 | if (ret) |
| 633 | goto err1; |
| 634 | |
| 635 | ret = send_reply(rdma, rqstp, res_page, rdma_resp, vec, |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 636 | inline_bytes); |
Chuck Lever | 3e1eeb9 | 2016-03-01 13:06:11 -0500 | [diff] [blame] | 637 | if (ret < 0) |
| 638 | goto err1; |
| 639 | |
Chuck Lever | 2fe81b2 | 2016-01-07 14:49:20 -0500 | [diff] [blame] | 640 | svc_rdma_put_req_map(rdma, vec); |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 641 | dprintk("svcrdma: send_reply returns %d\n", ret); |
| 642 | return ret; |
Tom Tucker | afd566e | 2008-10-03 15:45:03 -0500 | [diff] [blame] | 643 | |
| 644 | err1: |
| 645 | put_page(res_page); |
| 646 | err0: |
Chuck Lever | 2fe81b2 | 2016-01-07 14:49:20 -0500 | [diff] [blame] | 647 | svc_rdma_put_req_map(rdma, vec); |
Chuck Lever | 9ec6405 | 2016-05-04 10:53:05 -0400 | [diff] [blame^] | 648 | pr_err("svcrdma: Could not send reply, err=%d. Closing transport.\n", |
| 649 | ret); |
Chuck Lever | 3e1eeb9 | 2016-03-01 13:06:11 -0500 | [diff] [blame] | 650 | set_bit(XPT_CLOSE, &rdma->sc_xprt.xpt_flags); |
| 651 | return -ENOTCONN; |
Tom Tucker | c06b540 | 2007-12-12 16:13:25 -0600 | [diff] [blame] | 652 | } |
Chuck Lever | a6081b8 | 2016-03-01 13:06:38 -0500 | [diff] [blame] | 653 | |
| 654 | void svc_rdma_send_error(struct svcxprt_rdma *xprt, struct rpcrdma_msg *rmsgp, |
| 655 | int status) |
| 656 | { |
| 657 | struct ib_send_wr err_wr; |
| 658 | struct page *p; |
| 659 | struct svc_rdma_op_ctxt *ctxt; |
| 660 | enum rpcrdma_errcode err; |
| 661 | __be32 *va; |
| 662 | int length; |
| 663 | int ret; |
| 664 | |
| 665 | ret = svc_rdma_repost_recv(xprt, GFP_KERNEL); |
| 666 | if (ret) |
| 667 | return; |
| 668 | |
| 669 | p = alloc_page(GFP_KERNEL); |
| 670 | if (!p) |
| 671 | return; |
| 672 | va = page_address(p); |
| 673 | |
| 674 | /* XDR encode an error reply */ |
| 675 | err = ERR_CHUNK; |
| 676 | if (status == -EPROTONOSUPPORT) |
| 677 | err = ERR_VERS; |
| 678 | length = svc_rdma_xdr_encode_error(xprt, rmsgp, err, va); |
| 679 | |
| 680 | ctxt = svc_rdma_get_context(xprt); |
| 681 | ctxt->direction = DMA_TO_DEVICE; |
| 682 | ctxt->count = 1; |
| 683 | ctxt->pages[0] = p; |
| 684 | |
| 685 | /* Prepare SGE for local address */ |
| 686 | ctxt->sge[0].lkey = xprt->sc_pd->local_dma_lkey; |
| 687 | ctxt->sge[0].length = length; |
| 688 | ctxt->sge[0].addr = ib_dma_map_page(xprt->sc_cm_id->device, |
| 689 | p, 0, length, DMA_TO_DEVICE); |
| 690 | if (ib_dma_mapping_error(xprt->sc_cm_id->device, ctxt->sge[0].addr)) { |
| 691 | dprintk("svcrdma: Error mapping buffer for protocol error\n"); |
| 692 | svc_rdma_put_context(ctxt, 1); |
| 693 | return; |
| 694 | } |
| 695 | atomic_inc(&xprt->sc_dma_used); |
| 696 | |
| 697 | /* Prepare SEND WR */ |
| 698 | memset(&err_wr, 0, sizeof(err_wr)); |
Chuck Lever | be99bb1 | 2016-03-01 13:07:22 -0500 | [diff] [blame] | 699 | ctxt->cqe.done = svc_rdma_wc_send; |
| 700 | err_wr.wr_cqe = &ctxt->cqe; |
Chuck Lever | a6081b8 | 2016-03-01 13:06:38 -0500 | [diff] [blame] | 701 | err_wr.sg_list = ctxt->sge; |
| 702 | err_wr.num_sge = 1; |
| 703 | err_wr.opcode = IB_WR_SEND; |
| 704 | err_wr.send_flags = IB_SEND_SIGNALED; |
| 705 | |
| 706 | /* Post It */ |
| 707 | ret = svc_rdma_send(xprt, &err_wr); |
| 708 | if (ret) { |
| 709 | dprintk("svcrdma: Error %d posting send for protocol error\n", |
| 710 | ret); |
| 711 | svc_rdma_unmap_dma(ctxt); |
| 712 | svc_rdma_put_context(ctxt, 1); |
| 713 | } |
| 714 | } |