[deliverable/linux.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 : u32 offset into XDR stream
 *    handle   : u32 RKEY
 *    . . .
 *  end-of-list: xdr_zero
 */
static u32 *decode_read_list(u32 *va, u32 *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 (u32 *)&ch->rc_position;
}

/*
 * Determine number of chunks and total bytes in chunk list. The chunk
 * list has already been verified to fit within the RPCRDMA header.
 */
void svc_rdma_rcl_chunk_counts(struct rpcrdma_read_chunk *ch,
			       int *ch_count, int *byte_count)
{
	/* compute the number of bytes represented by read chunks */
	*byte_count = 0;
	*ch_count = 0;
	for (; ch->rc_discrim != 0; ch++) {
		*byte_count = *byte_count + ntohl(ch->rc_target.rs_length);
		*ch_count = *ch_count + 1;
	}
}

/*
 * Decodes a write chunk list. The expected format is as follows:
 *    descrim  : xdr_one
 *    nchunks  : <count>
 *       handle   : u32 RKEY              ---+
 *       length   : u32 <len of segment>     |
 *       offset   : remove va                + <count>
 *       . . .                               |
 *                                        ---+
 */
static u32 *decode_write_list(u32 *va, u32 *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 (u32 *)&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 = ntohl(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 (u32 *)&ary->wc_array[nchunks].wc_target.rs_length;
}

static u32 *decode_reply_array(u32 *va, u32 *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 (u32 *)&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 = ntohl(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 (u32 *)&ary->wc_array[nchunks];
}

int svc_rdma_xdr_decode_req(struct rpcrdma_msg **rdma_req,
			    struct svc_rqst *rqstp)
{
	struct rpcrdma_msg *rmsgp = NULL;
	u32 *va;
	u32 *vaend;
	u32 hdr_len;

	rmsgp = (struct rpcrdma_msg *)rqstp->rq_arg.head[0].iov_base;

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

	/* Decode the header */
	rmsgp->rm_xid = ntohl(rmsgp->rm_xid);
	rmsgp->rm_vers = ntohl(rmsgp->rm_vers);
	rmsgp->rm_credit = ntohl(rmsgp->rm_credit);
	rmsgp->rm_type = ntohl(rmsgp->rm_type);

	if (rmsgp->rm_vers != RPCRDMA_VERSION)
		return -ENOSYS;

	/* Pull in the extra for the padded case and bump our pointer */
	if (rmsgp->rm_type == RDMA_MSGP) {
		int hdrlen;
		rmsgp->rm_body.rm_padded.rm_align =
			ntohl(rmsgp->rm_body.rm_padded.rm_align);
		rmsgp->rm_body.rm_padded.rm_thresh =
			ntohl(rmsgp->rm_body.rm_padded.rm_thresh);

		va = &rmsgp->rm_body.rm_padded.rm_pempty[4];
		rqstp->rq_arg.head[0].iov_base = va;
		hdrlen = (u32)((unsigned long)va - (unsigned long)rmsgp);
		rqstp->rq_arg.head[0].iov_len -= hdrlen;
		if (hdrlen > rqstp->rq_arg.len)
			return -EINVAL;
		return hdrlen;
	}

	/* 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 = (u32 *)((unsigned long)rmsgp + rqstp->rq_arg.len);
	va = decode_read_list(va, vaend);
	if (!va)
		return -EINVAL;
	va = decode_write_list(va, vaend);
	if (!va)
		return -EINVAL;
	va = decode_reply_array(va, vaend);
	if (!va)
		return -EINVAL;

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

	*rdma_req = rmsgp;
	return hdr_len;
}

int svc_rdma_xdr_decode_deferred_req(struct svc_rqst *rqstp)
{
	struct rpcrdma_msg *rmsgp = NULL;
	struct rpcrdma_read_chunk *ch;
	struct rpcrdma_write_array *ary;
	u32 *va;
	u32 hdrlen;

	dprintk("svcrdma: processing deferred RDMA header on rqstp=%p\n",
		rqstp);
	rmsgp = (struct rpcrdma_msg *)rqstp->rq_arg.head[0].iov_base;

	/* Pull in the extra for the padded case and bump our pointer */
	if (rmsgp->rm_type == RDMA_MSGP) {
		va = &rmsgp->rm_body.rm_padded.rm_pempty[4];
		rqstp->rq_arg.head[0].iov_base = va;
		hdrlen = (u32)((unsigned long)va - (unsigned long)rmsgp);
		rqstp->rq_arg.head[0].iov_len -= hdrlen;
		return hdrlen;
	}

	/*
	 * Skip all chunks to find RPC msg. These were previously processed
	 */
	va = &rmsgp->rm_body.rm_chunks[0];

	/* Skip read-list */
	for (ch = (struct rpcrdma_read_chunk *)va;
	     ch->rc_discrim != xdr_zero; ch++);
	va = (u32 *)&ch->rc_position;

	/* Skip write-list */
	ary = (struct rpcrdma_write_array *)va;
	if (ary->wc_discrim == xdr_zero)
		va = (u32 *)&ary->wc_nchunks;
	else
		/*
		 * rs_length is the 2nd 4B field in wc_target and taking its
		 * address skips the list terminator
		 */
		va = (u32 *)&ary->wc_array[ary->wc_nchunks].wc_target.rs_length;

	/* Skip reply-array */
	ary = (struct rpcrdma_write_array *)va;
	if (ary->wc_discrim == xdr_zero)
		va = (u32 *)&ary->wc_nchunks;
	else
		va = (u32 *)&ary->wc_array[ary->wc_nchunks];

	rqstp->rq_arg.head[0].iov_base = va;
	hdrlen = (unsigned long)va - (unsigned long)rmsgp;
	rqstp->rq_arg.head[0].iov_len -= hdrlen;

	return hdrlen;
}

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

	*va++ = htonl(rmsgp->rm_xid);
	*va++ = htonl(rmsgp->rm_vers);
	*va++ = htonl(xprt->sc_max_requests);
	*va++ = htonl(RDMA_ERROR);
	*va++ = htonl(err);
	if (err == ERR_VERS) {
		*va++ = htonl(RPCRDMA_VERSION);
		*va++ = htonl(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[ntohl(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[ntohl(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 = htonl(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 = htonl(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 = htonl(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 = htonl(rdma_argp->rm_xid);
	rdma_resp->rm_vers = htonl(rdma_argp->rm_vers);
	rdma_resp->rm_credit = htonl(xprt->sc_max_requests);
	rdma_resp->rm_type = htonl(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
	53	* position : u32 offset into XDR stream
	54	* handle : u32 RKEY
	55	* . . .
	56	* end-of-list: xdr_zero
	57	*/
	58	static u32 decode_read_list(u32 va, u32 *vaend)
	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++;
	69	}
	70	return (u32 *)&ch->rc_position;
	71	}
	72
	73	/*
	74	* Determine number of chunks and total bytes in chunk list. The chunk
	75	* list has already been verified to fit within the RPCRDMA header.
	76	*/
	77	void svc_rdma_rcl_chunk_counts(struct rpcrdma_read_chunk *ch,
	78	int ch_count, int byte_count)
	79	{
	80	/* compute the number of bytes represented by read chunks */
	81	*byte_count = 0;
	82	*ch_count = 0;
	83	for (; ch->rc_discrim != 0; ch++) {
cec56c8f	84	byte_count = byte_count + ntohl(ch->rc_target.rs_length);
ef1eac0a TT	85	ch_count = ch_count + 1;
	86	}
	87	}
	88
	89	/*
	90	* Decodes a write chunk list. The expected format is as follows:
	91	* descrim : xdr_one
	92	* nchunks : <count>
	93	* handle : u32 RKEY ---+
	94	* length : u32 <len of segment> \|
	95	* offset : remove va + <count>
	96	* . . . \|
	97	* ---+
	98	*/
	99	static u32 decode_write_list(u32 va, u32 *vaend)
	100	{
b2781e10	101	unsigned long start, end;
cec56c8f TT	102	int nchunks;
cec56c8f TT	103
ef1eac0a TT	104	struct rpcrdma_write_array *ary =
	105	(struct rpcrdma_write_array *)va;
	106
	107	/* Check for not write-array */
	108	if (ary->wc_discrim == xdr_zero)
	109	return (u32 *)&ary->wc_nchunks;
	110
	111	if ((unsigned long)ary + sizeof(struct rpcrdma_write_array) >
	112	(unsigned long)vaend) {
	113	dprintk("svcrdma: ary=%p, vaend=%p\n", ary, vaend);
	114	return NULL;
	115	}
cec56c8f	116	nchunks = ntohl(ary->wc_nchunks);
b2781e10 DC	117
	118	start = (unsigned long)&ary->wc_array[0];
	119	end = (unsigned long)vaend;
	120	if (nchunks < 0 \|\|
	121	nchunks > (SIZE_MAX - start) / sizeof(struct rpcrdma_write_chunk) \|\|
	122	(start + (sizeof(struct rpcrdma_write_chunk) * nchunks)) > end) {
ef1eac0a	123	dprintk("svcrdma: ary=%p, wc_nchunks=%d, vaend=%p\n",
cec56c8f	124	ary, nchunks, vaend);
ef1eac0a TT	125	return NULL;
ef1eac0a TT	126	}
ef1eac0a TT	127	/*
	128	* rs_length is the 2nd 4B field in wc_target and taking its
	129	* address skips the list terminator
	130	*/
cec56c8f	131	return (u32 *)&ary->wc_array[nchunks].wc_target.rs_length;
ef1eac0a TT	132	}
	133
	134	static u32 decode_reply_array(u32 va, u32 *vaend)
	135	{
b2781e10	136	unsigned long start, end;
cec56c8f	137	int nchunks;
ef1eac0a TT	138	struct rpcrdma_write_array *ary =
	139	(struct rpcrdma_write_array *)va;
	140
	141	/* Check for no reply-array */
	142	if (ary->wc_discrim == xdr_zero)
	143	return (u32 *)&ary->wc_nchunks;
	144
	145	if ((unsigned long)ary + sizeof(struct rpcrdma_write_array) >
	146	(unsigned long)vaend) {
	147	dprintk("svcrdma: ary=%p, vaend=%p\n", ary, vaend);
	148	return NULL;
	149	}
cec56c8f	150	nchunks = ntohl(ary->wc_nchunks);
b2781e10 DC	151
	152	start = (unsigned long)&ary->wc_array[0];
	153	end = (unsigned long)vaend;
	154	if (nchunks < 0 \|\|
	155	nchunks > (SIZE_MAX - start) / sizeof(struct rpcrdma_write_chunk) \|\|
	156	(start + (sizeof(struct rpcrdma_write_chunk) * nchunks)) > end) {
ef1eac0a	157	dprintk("svcrdma: ary=%p, wc_nchunks=%d, vaend=%p\n",
cec56c8f	158	ary, nchunks, vaend);
ef1eac0a TT	159	return NULL;
ef1eac0a TT	160	}
cec56c8f	161	return (u32 *)&ary->wc_array[nchunks];
ef1eac0a TT	162	}
	163
	164	int svc_rdma_xdr_decode_req(struct rpcrdma_msg **rdma_req,
	165	struct svc_rqst *rqstp)
	166	{
	167	struct rpcrdma_msg *rmsgp = NULL;
	168	u32 *va;
	169	u32 *vaend;
	170	u32 hdr_len;
	171
	172	rmsgp = (struct rpcrdma_msg *)rqstp->rq_arg.head[0].iov_base;
	173
	174	/* Verify that there's enough bytes for header + something */
	175	if (rqstp->rq_arg.len <= RPCRDMA_HDRLEN_MIN) {
	176	dprintk("svcrdma: header too short = %d\n",
	177	rqstp->rq_arg.len);
	178	return -EINVAL;
	179	}
	180
	181	/* Decode the header */
	182	rmsgp->rm_xid = ntohl(rmsgp->rm_xid);
	183	rmsgp->rm_vers = ntohl(rmsgp->rm_vers);
	184	rmsgp->rm_credit = ntohl(rmsgp->rm_credit);
	185	rmsgp->rm_type = ntohl(rmsgp->rm_type);
	186
	187	if (rmsgp->rm_vers != RPCRDMA_VERSION)
	188	return -ENOSYS;
	189
	190	/* Pull in the extra for the padded case and bump our pointer */
	191	if (rmsgp->rm_type == RDMA_MSGP) {
	192	int hdrlen;
	193	rmsgp->rm_body.rm_padded.rm_align =
	194	ntohl(rmsgp->rm_body.rm_padded.rm_align);
	195	rmsgp->rm_body.rm_padded.rm_thresh =
	196	ntohl(rmsgp->rm_body.rm_padded.rm_thresh);
	197
	198	va = &rmsgp->rm_body.rm_padded.rm_pempty[4];
	199	rqstp->rq_arg.head[0].iov_base = va;
	200	hdrlen = (u32)((unsigned long)va - (unsigned long)rmsgp);
	201	rqstp->rq_arg.head[0].iov_len -= hdrlen;
	202	if (hdrlen > rqstp->rq_arg.len)
	203	return -EINVAL;
	204	return hdrlen;
	205	}
	206
	207	/* The chunk list may contain either a read chunk list or a write
	208	* chunk list and a reply chunk list.
	209	*/
	210	va = &rmsgp->rm_body.rm_chunks[0];
	211	vaend = (u32 *)((unsigned long)rmsgp + rqstp->rq_arg.len);
	212	va = decode_read_list(va, vaend);
	213	if (!va)
	214	return -EINVAL;
	215	va = decode_write_list(va, vaend);
	216	if (!va)
	217	return -EINVAL;
	218	va = decode_reply_array(va, vaend);
	219	if (!va)
	220	return -EINVAL;
	221
	222	rqstp->rq_arg.head[0].iov_base = va;
	223	hdr_len = (unsigned long)va - (unsigned long)rmsgp;
	224	rqstp->rq_arg.head[0].iov_len -= hdr_len;
	225
226	*rdma_req = rmsgp;
227	return hdr_len;
228	}
229
230	int svc_rdma_xdr_decode_deferred_req(struct svc_rqst *rqstp)
231	{
232	struct rpcrdma_msg *rmsgp = NULL;
233	struct rpcrdma_read_chunk *ch;
234	struct rpcrdma_write_array *ary;
235	u32 *va;
236	u32 hdrlen;
237
238	dprintk("svcrdma: processing deferred RDMA header on rqstp=%p\n",
239	rqstp);
240	rmsgp = (struct rpcrdma_msg *)rqstp->rq_arg.head[0].iov_base;
241
242	/* Pull in the extra for the padded case and bump our pointer */
243	if (rmsgp->rm_type == RDMA_MSGP) {
244	va = &rmsgp->rm_body.rm_padded.rm_pempty[4];
245	rqstp->rq_arg.head[0].iov_base = va;
246	hdrlen = (u32)((unsigned long)va - (unsigned long)rmsgp);
247	rqstp->rq_arg.head[0].iov_len -= hdrlen;
248	return hdrlen;
249	}
250
251	/*
252	* Skip all chunks to find RPC msg. These were previously processed
253	*/
254	va = &rmsgp->rm_body.rm_chunks[0];
255
256	/* Skip read-list */
257	for (ch = (struct rpcrdma_read_chunk *)va;
258	ch->rc_discrim != xdr_zero; ch++);
259	va = (u32 *)&ch->rc_position;
260
261	/* Skip write-list */
262	ary = (struct rpcrdma_write_array *)va;
263	if (ary->wc_discrim == xdr_zero)
264	va = (u32 *)&ary->wc_nchunks;
265	else
266	/*
267	* rs_length is the 2nd 4B field in wc_target and taking its
268	* address skips the list terminator
269	*/
270	va = (u32 *)&ary->wc_array[ary->wc_nchunks].wc_target.rs_length;
271
272	/* Skip reply-array */
273	ary = (struct rpcrdma_write_array *)va;
274	if (ary->wc_discrim == xdr_zero)
275	va = (u32 *)&ary->wc_nchunks;
276	else
277	va = (u32 *)&ary->wc_array[ary->wc_nchunks];
278
279	rqstp->rq_arg.head[0].iov_base = va;
280	hdrlen = (unsigned long)va - (unsigned long)rmsgp;
281	rqstp->rq_arg.head[0].iov_len -= hdrlen;
282
283	return hdrlen;
284	}
285
286	int svc_rdma_xdr_encode_error(struct svcxprt_rdma *xprt,
287	struct rpcrdma_msg *rmsgp,
288	enum rpcrdma_errcode err, u32 *va)
289	{
290	u32 *startp = va;
291
292	*va++ = htonl(rmsgp->rm_xid);
293	*va++ = htonl(rmsgp->rm_vers);
294	*va++ = htonl(xprt->sc_max_requests);
295	*va++ = htonl(RDMA_ERROR);
296	*va++ = htonl(err);
297	if (err == ERR_VERS) {
298	*va++ = htonl(RPCRDMA_VERSION);
299	*va++ = htonl(RPCRDMA_VERSION);
300	}
301
302	return (int)((unsigned long)va - (unsigned long)startp);
303	}
304
305	int svc_rdma_xdr_get_reply_hdr_len(struct rpcrdma_msg *rmsgp)
306	{
307	struct rpcrdma_write_array *wr_ary;
308
309	/* There is no read-list in a reply */
310
311	/* skip write list */
312	wr_ary = (struct rpcrdma_write_array *)
313	&rmsgp->rm_body.rm_chunks[1];
314	if (wr_ary->wc_discrim)
315	wr_ary = (struct rpcrdma_write_array *)
316	&wr_ary->wc_array[ntohl(wr_ary->wc_nchunks)].
317	wc_target.rs_length;
318	else
319	wr_ary = (struct rpcrdma_write_array *)
320	&wr_ary->wc_nchunks;
321
322	/* skip reply array */
323	if (wr_ary->wc_discrim)
324	wr_ary = (struct rpcrdma_write_array *)
325	&wr_ary->wc_array[ntohl(wr_ary->wc_nchunks)];
326	else
327	wr_ary = (struct rpcrdma_write_array *)
328	&wr_ary->wc_nchunks;
329
330	return (unsigned long) wr_ary - (unsigned long) rmsgp;
331	}
332
333	void svc_rdma_xdr_encode_write_list(struct rpcrdma_msg *rmsgp, int chunks)
334	{
335	struct rpcrdma_write_array *ary;
336
337	/* no read-list */
338	rmsgp->rm_body.rm_chunks[0] = xdr_zero;
339
340	/* write-array discrim */
341	ary = (struct rpcrdma_write_array *)
342	&rmsgp->rm_body.rm_chunks[1];
343	ary->wc_discrim = xdr_one;
344	ary->wc_nchunks = htonl(chunks);
345
346	/* write-list terminator */
347	ary->wc_array[chunks].wc_target.rs_handle = xdr_zero;
348
349	/* reply-array discriminator */
350	ary->wc_array[chunks].wc_target.rs_length = xdr_zero;
351	}
352
353	void svc_rdma_xdr_encode_reply_array(struct rpcrdma_write_array *ary,
354	int chunks)
355	{
356	ary->wc_discrim = xdr_one;
357	ary->wc_nchunks = htonl(chunks);
358	}
359
360	void svc_rdma_xdr_encode_array_chunk(struct rpcrdma_write_array *ary,
361	int chunk_no,
cec56c8f TT	362	__be32 rs_handle,
cec56c8f TT	363	__be64 rs_offset,
ef1eac0a TT	364	u32 write_len)
	365	{
	366	struct rpcrdma_segment *seg = &ary->wc_array[chunk_no].wc_target;
cec56c8f TT	367	seg->rs_handle = rs_handle;
cec56c8f TT	368	seg->rs_offset = rs_offset;
ef1eac0a	369	seg->rs_length = htonl(write_len);
ef1eac0a TT	370	}
	371
	372	void svc_rdma_xdr_encode_reply_header(struct svcxprt_rdma *xprt,
	373	struct rpcrdma_msg *rdma_argp,
	374	struct rpcrdma_msg *rdma_resp,
	375	enum rpcrdma_proc rdma_type)
	376	{
	377	rdma_resp->rm_xid = htonl(rdma_argp->rm_xid);
	378	rdma_resp->rm_vers = htonl(rdma_argp->rm_vers);
	379	rdma_resp->rm_credit = htonl(xprt->sc_max_requests);
	380	rdma_resp->rm_type = htonl(rdma_type);
	381
	382	/* Encode <nul> chunks lists */
	383	rdma_resp->rm_body.rm_chunks[0] = xdr_zero;
	384	rdma_resp->rm_body.rm_chunks[1] = xdr_zero;
	385	rdma_resp->rm_body.rm_chunks[2] = xdr_zero;
	386	}