[GitHub/moto-9609/android_kernel_motorola_exynos9610.git] / net / sunrpc / xprtrdma / svc_rdma_marshal.c

/*
 * Copyright (c) 2005-2006 Network Appliance, Inc. All rights reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the BSD-type
 * license below:
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 *      Redistributions of source code must retain the above copyright
 *      notice, this list of conditions and the following disclaimer.
 *
 *      Redistributions in binary form must reproduce the above
 *      copyright notice, this list of conditions and the following
 *      disclaimer in the documentation and/or other materials provided
 *      with the distribution.
 *
 *      Neither the name of the Network Appliance, Inc. nor the names of
 *      its contributors may be used to endorse or promote products
 *      derived from this software without specific prior written
 *      permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 * Author: Tom Tucker <tom@opengridcomputing.com>
 */

#include <linux/sunrpc/xdr.h>
#include <linux/sunrpc/debug.h>
#include <asm/unaligned.h>
#include <linux/sunrpc/rpc_rdma.h>
#include <linux/sunrpc/svc_rdma.h>

#define RPCDBG_FACILITY	RPCDBG_SVCXPRT

/*
 * Decodes a read chunk list. The expected format is as follows:
 *    descrim  : xdr_one
 *    position : __be32 offset into XDR stream
 *    handle   : __be32 RKEY
 *    . . .
 *  end-of-list: xdr_zero
 */
static __be32 *decode_read_list(__be32 *va, __be32 *vaend)
{
	struct rpcrdma_read_chunk *ch = (struct rpcrdma_read_chunk *)va;

	while (ch->rc_discrim != xdr_zero) {
		if (((unsigned long)ch + sizeof(struct rpcrdma_read_chunk)) >
		    (unsigned long)vaend) {
			dprintk("svcrdma: vaend=%p, ch=%p\n", vaend, ch);
			return NULL;
		}
		ch++;
	}
	return &ch->rc_position;
}

/*
 * Decodes a write chunk list. The expected format is as follows:
 *    descrim  : xdr_one
 *    nchunks  : <count>
 *       handle   : __be32 RKEY           ---+
 *       length   : __be32 <len of segment>  |
 *       offset   : remove va                + <count>
 *       . . .                               |
 *                                        ---+
 */
static __be32 *decode_write_list(__be32 *va, __be32 *vaend)
{
	unsigned long start, end;
	int nchunks;

	struct rpcrdma_write_array *ary =
		(struct rpcrdma_write_array *)va;

	/* Check for not write-array */
	if (ary->wc_discrim == xdr_zero)
		return &ary->wc_nchunks;

	if ((unsigned long)ary + sizeof(struct rpcrdma_write_array) >
	    (unsigned long)vaend) {
		dprintk("svcrdma: ary=%p, vaend=%p\n", ary, vaend);
		return NULL;
	}
	nchunks = be32_to_cpu(ary->wc_nchunks);

	start = (unsigned long)&ary->wc_array[0];
	end = (unsigned long)vaend;
	if (nchunks < 0 ||
	    nchunks > (SIZE_MAX - start) / sizeof(struct rpcrdma_write_chunk) ||
	    (start + (sizeof(struct rpcrdma_write_chunk) * nchunks)) > end) {
		dprintk("svcrdma: ary=%p, wc_nchunks=%d, vaend=%p\n",
			ary, nchunks, vaend);
		return NULL;
	}
	/*
	 * rs_length is the 2nd 4B field in wc_target and taking its
	 * address skips the list terminator
	 */
	return &ary->wc_array[nchunks].wc_target.rs_length;
}

static __be32 *decode_reply_array(__be32 *va, __be32 *vaend)
{
	unsigned long start, end;
	int nchunks;
	struct rpcrdma_write_array *ary =
		(struct rpcrdma_write_array *)va;

	/* Check for no reply-array */
	if (ary->wc_discrim == xdr_zero)
		return &ary->wc_nchunks;

	if ((unsigned long)ary + sizeof(struct rpcrdma_write_array) >
	    (unsigned long)vaend) {
		dprintk("svcrdma: ary=%p, vaend=%p\n", ary, vaend);
		return NULL;
	}
	nchunks = be32_to_cpu(ary->wc_nchunks);

	start = (unsigned long)&ary->wc_array[0];
	end = (unsigned long)vaend;
	if (nchunks < 0 ||
	    nchunks > (SIZE_MAX - start) / sizeof(struct rpcrdma_write_chunk) ||
	    (start + (sizeof(struct rpcrdma_write_chunk) * nchunks)) > end) {
		dprintk("svcrdma: ary=%p, wc_nchunks=%d, vaend=%p\n",
			ary, nchunks, vaend);
		return NULL;
	}
	return (__be32 *)&ary->wc_array[nchunks];
}

/**
 * svc_rdma_xdr_decode_req - Parse incoming RPC-over-RDMA header
 * @rq_arg: Receive buffer
 *
 * On entry, xdr->head[0].iov_base points to first byte in the
 * RPC-over-RDMA header.
 *
 * On successful exit, head[0] points to first byte past the
 * RPC-over-RDMA header. For RDMA_MSG, this is the RPC message.
 * The length of the RPC-over-RDMA header is returned.
 */
int svc_rdma_xdr_decode_req(struct xdr_buf *rq_arg)
{
	struct rpcrdma_msg *rmsgp;
	__be32 *va, *vaend;
	unsigned int len;
	u32 hdr_len;

	/* Verify that there's enough bytes for header + something */
	if (rq_arg->len <= RPCRDMA_HDRLEN_ERR) {
		dprintk("svcrdma: header too short = %d\n",
			rq_arg->len);
		return -EINVAL;
	}

	rmsgp = (struct rpcrdma_msg *)rq_arg->head[0].iov_base;
	if (rmsgp->rm_vers != rpcrdma_version) {
		dprintk("%s: bad version %u\n", __func__,
			be32_to_cpu(rmsgp->rm_vers));
		return -EPROTONOSUPPORT;
	}

	switch (be32_to_cpu(rmsgp->rm_type)) {
	case RDMA_MSG:
	case RDMA_NOMSG:
		break;

	case RDMA_DONE:
		/* Just drop it */
		dprintk("svcrdma: dropping RDMA_DONE message\n");
		return 0;

	case RDMA_ERROR:
		/* Possible if this is a backchannel reply.
		 * XXX: We should cancel this XID, though.
		 */
		dprintk("svcrdma: dropping RDMA_ERROR message\n");
		return 0;

	case RDMA_MSGP:
		/* Pull in the extra for the padded case, bump our pointer */
		rmsgp->rm_body.rm_padded.rm_align =
			be32_to_cpu(rmsgp->rm_body.rm_padded.rm_align);
		rmsgp->rm_body.rm_padded.rm_thresh =
			be32_to_cpu(rmsgp->rm_body.rm_padded.rm_thresh);

		va = &rmsgp->rm_body.rm_padded.rm_pempty[4];
		rq_arg->head[0].iov_base = va;
		len = (u32)((unsigned long)va - (unsigned long)rmsgp);
		rq_arg->head[0].iov_len -= len;
		if (len > rq_arg->len)
			return -EINVAL;
		return len;
	default:
		dprintk("svcrdma: bad rdma procedure (%u)\n",
			be32_to_cpu(rmsgp->rm_type));
		return -EINVAL;
	}

	/* The chunk list may contain either a read chunk list or a write
	 * chunk list and a reply chunk list.
	 */
	va = &rmsgp->rm_body.rm_chunks[0];
	vaend = (__be32 *)((unsigned long)rmsgp + rq_arg->len);
	va = decode_read_list(va, vaend);
	if (!va) {
		dprintk("svcrdma: failed to decode read list\n");
		return -EINVAL;
	}
	va = decode_write_list(va, vaend);
	if (!va) {
		dprintk("svcrdma: failed to decode write list\n");
		return -EINVAL;
	}
	va = decode_reply_array(va, vaend);
	if (!va) {
		dprintk("svcrdma: failed to decode reply chunk\n");
		return -EINVAL;
	}

	rq_arg->head[0].iov_base = va;
	hdr_len = (unsigned long)va - (unsigned long)rmsgp;
	rq_arg->head[0].iov_len -= hdr_len;
	return hdr_len;
}

int svc_rdma_xdr_encode_error(struct svcxprt_rdma *xprt,
			      struct rpcrdma_msg *rmsgp,
			      enum rpcrdma_errcode err, __be32 *va)
{
	__be32 *startp = va;

	*va++ = rmsgp->rm_xid;
	*va++ = rmsgp->rm_vers;
	*va++ = cpu_to_be32(xprt->sc_max_requests);
	*va++ = rdma_error;
	*va++ = cpu_to_be32(err);
	if (err == ERR_VERS) {
		*va++ = rpcrdma_version;
		*va++ = rpcrdma_version;
	}

	return (int)((unsigned long)va - (unsigned long)startp);
}

int svc_rdma_xdr_get_reply_hdr_len(struct rpcrdma_msg *rmsgp)
{
	struct rpcrdma_write_array *wr_ary;

	/* There is no read-list in a reply */

	/* skip write list */
	wr_ary = (struct rpcrdma_write_array *)
		&rmsgp->rm_body.rm_chunks[1];
	if (wr_ary->wc_discrim)
		wr_ary = (struct rpcrdma_write_array *)
			&wr_ary->wc_array[be32_to_cpu(wr_ary->wc_nchunks)].
			wc_target.rs_length;
	else
		wr_ary = (struct rpcrdma_write_array *)
			&wr_ary->wc_nchunks;

	/* skip reply array */
	if (wr_ary->wc_discrim)
		wr_ary = (struct rpcrdma_write_array *)
			&wr_ary->wc_array[be32_to_cpu(wr_ary->wc_nchunks)];
	else
		wr_ary = (struct rpcrdma_write_array *)
			&wr_ary->wc_nchunks;

	return (unsigned long) wr_ary - (unsigned long) rmsgp;
}

void svc_rdma_xdr_encode_write_list(struct rpcrdma_msg *rmsgp, int chunks)
{
	struct rpcrdma_write_array *ary;

	/* no read-list */
	rmsgp->rm_body.rm_chunks[0] = xdr_zero;

	/* write-array discrim */
	ary = (struct rpcrdma_write_array *)
		&rmsgp->rm_body.rm_chunks[1];
	ary->wc_discrim = xdr_one;
	ary->wc_nchunks = cpu_to_be32(chunks);

	/* write-list terminator */
	ary->wc_array[chunks].wc_target.rs_handle = xdr_zero;

	/* reply-array discriminator */
	ary->wc_array[chunks].wc_target.rs_length = xdr_zero;
}

void svc_rdma_xdr_encode_reply_array(struct rpcrdma_write_array *ary,
				 int chunks)
{
	ary->wc_discrim = xdr_one;
	ary->wc_nchunks = cpu_to_be32(chunks);
}

void svc_rdma_xdr_encode_array_chunk(struct rpcrdma_write_array *ary,
				     int chunk_no,
				     __be32 rs_handle,
				     __be64 rs_offset,
				     u32 write_len)
{
	struct rpcrdma_segment *seg = &ary->wc_array[chunk_no].wc_target;
	seg->rs_handle = rs_handle;
	seg->rs_offset = rs_offset;
	seg->rs_length = cpu_to_be32(write_len);
}

void svc_rdma_xdr_encode_reply_header(struct svcxprt_rdma *xprt,
				  struct rpcrdma_msg *rdma_argp,
				  struct rpcrdma_msg *rdma_resp,
				  enum rpcrdma_proc rdma_type)
{
	rdma_resp->rm_xid = rdma_argp->rm_xid;
	rdma_resp->rm_vers = rdma_argp->rm_vers;
	rdma_resp->rm_credit = cpu_to_be32(xprt->sc_max_requests);
	rdma_resp->rm_type = cpu_to_be32(rdma_type);

	/* Encode <nul> chunks lists */
	rdma_resp->rm_body.rm_chunks[0] = xdr_zero;
	rdma_resp->rm_body.rm_chunks[1] = xdr_zero;
	rdma_resp->rm_body.rm_chunks[2] = xdr_zero;
}
Commit	Line	Data
ef1eac0a TT	1	/*
	2	* Copyright (c) 2005-2006 Network Appliance, Inc. All rights reserved.
	3	*
	4	* This software is available to you under a choice of one of two
	5	* licenses. You may choose to be licensed under the terms of the GNU
	6	* General Public License (GPL) Version 2, available from the file
	7	* COPYING in the main directory of this source tree, or the BSD-type
	8	* license below:
	9	*
	10	* Redistribution and use in source and binary forms, with or without
	11	* modification, are permitted provided that the following conditions
	12	* are met:
	13	*
	14	* Redistributions of source code must retain the above copyright
	15	* notice, this list of conditions and the following disclaimer.
	16	*
	17	* Redistributions in binary form must reproduce the above
	18	* copyright notice, this list of conditions and the following
	19	* disclaimer in the documentation and/or other materials provided
	20	* with the distribution.
	21	*
	22	* Neither the name of the Network Appliance, Inc. nor the names of
	23	* its contributors may be used to endorse or promote products
	24	* derived from this software without specific prior written
	25	* permission.
	26	*
	27	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
	28	* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
	29	* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
	30	* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
	31	* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
	32	* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
	33	* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
	34	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
	35	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	36	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
	37	* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	38	*
	39	* Author: Tom Tucker <tom@opengridcomputing.com>
	40	*/
	41
	42	#include <linux/sunrpc/xdr.h>
	43	#include <linux/sunrpc/debug.h>
	44	#include <asm/unaligned.h>
	45	#include <linux/sunrpc/rpc_rdma.h>
	46	#include <linux/sunrpc/svc_rdma.h>
	47
	48	#define RPCDBG_FACILITY RPCDBG_SVCXPRT
	49
	50	/*
	51	* Decodes a read chunk list. The expected format is as follows:
	52	* descrim : xdr_one
30b7e246 CL	53	* position : __be32 offset into XDR stream
30b7e246 CL	54	* handle : __be32 RKEY
ef1eac0a TT	55	* . . .
	56	* end-of-list: xdr_zero
	57	*/
30b7e246	58	static __be32 decode_read_list(__be32 va, __be32 *vaend)
ef1eac0a TT	59	{
	60	struct rpcrdma_read_chunk ch = (struct rpcrdma_read_chunk )va;
	61
	62	while (ch->rc_discrim != xdr_zero) {
ef1eac0a TT	63	if (((unsigned long)ch + sizeof(struct rpcrdma_read_chunk)) >
	64	(unsigned long)vaend) {
	65	dprintk("svcrdma: vaend=%p, ch=%p\n", vaend, ch);
	66	return NULL;
	67	}
ef1eac0a TT	68	ch++;
ef1eac0a TT	69	}
30b7e246	70	return &ch->rc_position;
ef1eac0a TT	71	}
ef1eac0a TT	72
ef1eac0a TT	73	/*
	74	* Decodes a write chunk list. The expected format is as follows:
	75	* descrim : xdr_one
	76	* nchunks : <count>
30b7e246 CL	77	* handle : __be32 RKEY ---+
30b7e246 CL	78	* length : __be32 <len of segment> \|
ef1eac0a TT	79	* offset : remove va + <count>
	80	* . . . \|
	81	* ---+
	82	*/
30b7e246	83	static __be32 decode_write_list(__be32 va, __be32 *vaend)
ef1eac0a	84	{
b2781e10	85	unsigned long start, end;
cec56c8f TT	86	int nchunks;
cec56c8f TT	87
ef1eac0a TT	88	struct rpcrdma_write_array *ary =
	89	(struct rpcrdma_write_array *)va;
	90
	91	/* Check for not write-array */
	92	if (ary->wc_discrim == xdr_zero)
30b7e246	93	return &ary->wc_nchunks;
ef1eac0a TT	94
	95	if ((unsigned long)ary + sizeof(struct rpcrdma_write_array) >
	96	(unsigned long)vaend) {
	97	dprintk("svcrdma: ary=%p, vaend=%p\n", ary, vaend);
	98	return NULL;
	99	}
30b7e246	100	nchunks = be32_to_cpu(ary->wc_nchunks);
b2781e10 DC	101
	102	start = (unsigned long)&ary->wc_array[0];
	103	end = (unsigned long)vaend;
	104	if (nchunks < 0 \|\|
	105	nchunks > (SIZE_MAX - start) / sizeof(struct rpcrdma_write_chunk) \|\|
	106	(start + (sizeof(struct rpcrdma_write_chunk) * nchunks)) > end) {
ef1eac0a	107	dprintk("svcrdma: ary=%p, wc_nchunks=%d, vaend=%p\n",
cec56c8f	108	ary, nchunks, vaend);
ef1eac0a TT	109	return NULL;
ef1eac0a TT	110	}
ef1eac0a TT	111	/*
	112	* rs_length is the 2nd 4B field in wc_target and taking its
	113	* address skips the list terminator
	114	*/
30b7e246	115	return &ary->wc_array[nchunks].wc_target.rs_length;
ef1eac0a TT	116	}
ef1eac0a TT	117
30b7e246	118	static __be32 decode_reply_array(__be32 va, __be32 *vaend)
ef1eac0a	119	{
b2781e10	120	unsigned long start, end;
cec56c8f	121	int nchunks;
ef1eac0a TT	122	struct rpcrdma_write_array *ary =
	123	(struct rpcrdma_write_array *)va;
	124
	125	/* Check for no reply-array */
	126	if (ary->wc_discrim == xdr_zero)
30b7e246	127	return &ary->wc_nchunks;
ef1eac0a TT	128
	129	if ((unsigned long)ary + sizeof(struct rpcrdma_write_array) >
	130	(unsigned long)vaend) {
	131	dprintk("svcrdma: ary=%p, vaend=%p\n", ary, vaend);
	132	return NULL;
	133	}
30b7e246	134	nchunks = be32_to_cpu(ary->wc_nchunks);
b2781e10 DC	135
	136	start = (unsigned long)&ary->wc_array[0];
	137	end = (unsigned long)vaend;
	138	if (nchunks < 0 \|\|
	139	nchunks > (SIZE_MAX - start) / sizeof(struct rpcrdma_write_chunk) \|\|
	140	(start + (sizeof(struct rpcrdma_write_chunk) * nchunks)) > end) {
ef1eac0a	141	dprintk("svcrdma: ary=%p, wc_nchunks=%d, vaend=%p\n",
cec56c8f	142	ary, nchunks, vaend);
ef1eac0a TT	143	return NULL;
ef1eac0a TT	144	}
30b7e246	145	return (__be32 *)&ary->wc_array[nchunks];
ef1eac0a TT	146	}
ef1eac0a TT	147
d9e4084f CL	148	/**
	149	* svc_rdma_xdr_decode_req - Parse incoming RPC-over-RDMA header
	150	* @rq_arg: Receive buffer
	151	*
	152	* On entry, xdr->head[0].iov_base points to first byte in the
	153	* RPC-over-RDMA header.
	154	*
	155	* On successful exit, head[0] points to first byte past the
	156	* RPC-over-RDMA header. For RDMA_MSG, this is the RPC message.
	157	* The length of the RPC-over-RDMA header is returned.
	158	*/
	159	int svc_rdma_xdr_decode_req(struct xdr_buf *rq_arg)
ef1eac0a	160	{
d9e4084f	161	struct rpcrdma_msg *rmsgp;
30b7e246	162	__be32 va, vaend;
a0544c94	163	unsigned int len;
ef1eac0a TT	164	u32 hdr_len;
ef1eac0a TT	165
ef1eac0a	166	/* Verify that there's enough bytes for header + something */
d9e4084f	167	if (rq_arg->len <= RPCRDMA_HDRLEN_ERR) {
ef1eac0a	168	dprintk("svcrdma: header too short = %d\n",
d9e4084f	169	rq_arg->len);
ef1eac0a TT	170	return -EINVAL;
	171	}
	172
d9e4084f	173	rmsgp = (struct rpcrdma_msg *)rq_arg->head[0].iov_base;
a0544c94 CL	174	if (rmsgp->rm_vers != rpcrdma_version) {
	175	dprintk("%s: bad version %u\n", __func__,
	176	be32_to_cpu(rmsgp->rm_vers));
a6081b82	177	return -EPROTONOSUPPORT;
a0544c94 CL	178	}
	179
	180	switch (be32_to_cpu(rmsgp->rm_type)) {
	181	case RDMA_MSG:
	182	case RDMA_NOMSG:
	183	break;
ef1eac0a	184
a0544c94 CL	185	case RDMA_DONE:
	186	/* Just drop it */
	187	dprintk("svcrdma: dropping RDMA_DONE message\n");
	188	return 0;
30b7e246	189
a0544c94 CL	190	case RDMA_ERROR:
	191	/* Possible if this is a backchannel reply.
	192	* XXX: We should cancel this XID, though.
	193	*/
	194	dprintk("svcrdma: dropping RDMA_ERROR message\n");
	195	return 0;
	196
	197	case RDMA_MSGP:
	198	/* Pull in the extra for the padded case, bump our pointer */
ef1eac0a	199	rmsgp->rm_body.rm_padded.rm_align =
30b7e246	200	be32_to_cpu(rmsgp->rm_body.rm_padded.rm_align);
ef1eac0a	201	rmsgp->rm_body.rm_padded.rm_thresh =
30b7e246	202	be32_to_cpu(rmsgp->rm_body.rm_padded.rm_thresh);
ef1eac0a TT	203
ef1eac0a TT	204	va = &rmsgp->rm_body.rm_padded.rm_pempty[4];
d9e4084f	205	rq_arg->head[0].iov_base = va;
a0544c94	206	len = (u32)((unsigned long)va - (unsigned long)rmsgp);
d9e4084f CL	207	rq_arg->head[0].iov_len -= len;
d9e4084f CL	208	if (len > rq_arg->len)
ef1eac0a	209	return -EINVAL;
a0544c94 CL	210	return len;
	211	default:
	212	dprintk("svcrdma: bad rdma procedure (%u)\n",
	213	be32_to_cpu(rmsgp->rm_type));
	214	return -EINVAL;
ef1eac0a TT	215	}
	216
	217	/* The chunk list may contain either a read chunk list or a write
	218	* chunk list and a reply chunk list.
	219	*/
	220	va = &rmsgp->rm_body.rm_chunks[0];
d9e4084f	221	vaend = (__be32 *)((unsigned long)rmsgp + rq_arg->len);
ef1eac0a	222	va = decode_read_list(va, vaend);
a0544c94 CL	223	if (!va) {
a0544c94 CL	224	dprintk("svcrdma: failed to decode read list\n");
ef1eac0a	225	return -EINVAL;
a0544c94	226	}
ef1eac0a	227	va = decode_write_list(va, vaend);
a0544c94 CL	228	if (!va) {
a0544c94 CL	229	dprintk("svcrdma: failed to decode write list\n");
ef1eac0a	230	return -EINVAL;
a0544c94	231	}
ef1eac0a	232	va = decode_reply_array(va, vaend);
a0544c94 CL	233	if (!va) {
a0544c94 CL	234	dprintk("svcrdma: failed to decode reply chunk\n");
ef1eac0a	235	return -EINVAL;
a0544c94	236	}
ef1eac0a	237
d9e4084f	238	rq_arg->head[0].iov_base = va;
ef1eac0a	239	hdr_len = (unsigned long)va - (unsigned long)rmsgp;
d9e4084f	240	rq_arg->head[0].iov_len -= hdr_len;
ef1eac0a TT	241	return hdr_len;
	242	}
	243
ef1eac0a TT	244	int svc_rdma_xdr_encode_error(struct svcxprt_rdma *xprt,
ef1eac0a TT	245	struct rpcrdma_msg *rmsgp,
30b7e246	246	enum rpcrdma_errcode err, __be32 *va)
ef1eac0a	247	{
30b7e246	248	__be32 *startp = va;
ef1eac0a	249
30b7e246 CL	250	*va++ = rmsgp->rm_xid;
	251	*va++ = rmsgp->rm_vers;
	252	*va++ = cpu_to_be32(xprt->sc_max_requests);
	253	*va++ = rdma_error;
	254	*va++ = cpu_to_be32(err);
ef1eac0a	255	if (err == ERR_VERS) {
30b7e246 CL	256	*va++ = rpcrdma_version;
30b7e246 CL	257	*va++ = rpcrdma_version;
ef1eac0a TT	258	}
	259
	260	return (int)((unsigned long)va - (unsigned long)startp);
	261	}
	262
	263	int svc_rdma_xdr_get_reply_hdr_len(struct rpcrdma_msg *rmsgp)
	264	{
	265	struct rpcrdma_write_array *wr_ary;
	266
	267	/* There is no read-list in a reply */
	268
	269	/* skip write list */
	270	wr_ary = (struct rpcrdma_write_array *)
	271	&rmsgp->rm_body.rm_chunks[1];
	272	if (wr_ary->wc_discrim)
	273	wr_ary = (struct rpcrdma_write_array *)
30b7e246	274	&wr_ary->wc_array[be32_to_cpu(wr_ary->wc_nchunks)].
ef1eac0a TT	275	wc_target.rs_length;
	276	else
	277	wr_ary = (struct rpcrdma_write_array *)
	278	&wr_ary->wc_nchunks;
	279
	280	/* skip reply array */
	281	if (wr_ary->wc_discrim)
	282	wr_ary = (struct rpcrdma_write_array *)
30b7e246	283	&wr_ary->wc_array[be32_to_cpu(wr_ary->wc_nchunks)];
ef1eac0a TT	284	else
	285	wr_ary = (struct rpcrdma_write_array *)
	286	&wr_ary->wc_nchunks;
	287
	288	return (unsigned long) wr_ary - (unsigned long) rmsgp;
	289	}
	290
	291	void svc_rdma_xdr_encode_write_list(struct rpcrdma_msg *rmsgp, int chunks)
	292	{
	293	struct rpcrdma_write_array *ary;
	294
	295	/* no read-list */
	296	rmsgp->rm_body.rm_chunks[0] = xdr_zero;
	297
	298	/* write-array discrim */
	299	ary = (struct rpcrdma_write_array *)
	300	&rmsgp->rm_body.rm_chunks[1];
	301	ary->wc_discrim = xdr_one;
30b7e246	302	ary->wc_nchunks = cpu_to_be32(chunks);
ef1eac0a TT	303
	304	/* write-list terminator */
	305	ary->wc_array[chunks].wc_target.rs_handle = xdr_zero;
	306
	307	/* reply-array discriminator */
	308	ary->wc_array[chunks].wc_target.rs_length = xdr_zero;
	309	}
	310
	311	void svc_rdma_xdr_encode_reply_array(struct rpcrdma_write_array *ary,
	312	int chunks)
	313	{
	314	ary->wc_discrim = xdr_one;
30b7e246	315	ary->wc_nchunks = cpu_to_be32(chunks);
ef1eac0a TT	316	}
	317
	318	void svc_rdma_xdr_encode_array_chunk(struct rpcrdma_write_array *ary,
	319	int chunk_no,
cec56c8f TT	320	__be32 rs_handle,
cec56c8f TT	321	__be64 rs_offset,
ef1eac0a TT	322	u32 write_len)
	323	{
	324	struct rpcrdma_segment *seg = &ary->wc_array[chunk_no].wc_target;
cec56c8f TT	325	seg->rs_handle = rs_handle;
cec56c8f TT	326	seg->rs_offset = rs_offset;
30b7e246	327	seg->rs_length = cpu_to_be32(write_len);
ef1eac0a TT	328	}
	329
	330	void svc_rdma_xdr_encode_reply_header(struct svcxprt_rdma *xprt,
	331	struct rpcrdma_msg *rdma_argp,
	332	struct rpcrdma_msg *rdma_resp,
	333	enum rpcrdma_proc rdma_type)
	334	{
30b7e246 CL	335	rdma_resp->rm_xid = rdma_argp->rm_xid;
	336	rdma_resp->rm_vers = rdma_argp->rm_vers;
	337	rdma_resp->rm_credit = cpu_to_be32(xprt->sc_max_requests);
	338	rdma_resp->rm_type = cpu_to_be32(rdma_type);
ef1eac0a TT	339
	340	/* Encode <nul> chunks lists */
	341	rdma_resp->rm_body.rm_chunks[0] = xdr_zero;
	342	rdma_resp->rm_body.rm_chunks[1] = xdr_zero;
	343	rdma_resp->rm_body.rm_chunks[2] = xdr_zero;
	344	}