[deliverable/linux.git] / fs / nfsd / blocklayoutxdr.c

/*
 * Copyright (c) 2014-2016 Christoph Hellwig.
 */
#include <linux/sunrpc/svc.h>
#include <linux/exportfs.h>
#include <linux/nfs4.h>

#include "nfsd.h"
#include "blocklayoutxdr.h"

#define NFSDDBG_FACILITY	NFSDDBG_PNFS


__be32
nfsd4_block_encode_layoutget(struct xdr_stream *xdr,
		struct nfsd4_layoutget *lgp)
{
	struct pnfs_block_extent *b = lgp->lg_content;
	int len = sizeof(__be32) + 5 * sizeof(__be64) + sizeof(__be32);
	__be32 *p;

	p = xdr_reserve_space(xdr, sizeof(__be32) + len);
	if (!p)
		return nfserr_toosmall;

	*p++ = cpu_to_be32(len);
	*p++ = cpu_to_be32(1);		/* we always return a single extent */

	p = xdr_encode_opaque_fixed(p, &b->vol_id,
			sizeof(struct nfsd4_deviceid));
	p = xdr_encode_hyper(p, b->foff);
	p = xdr_encode_hyper(p, b->len);
	p = xdr_encode_hyper(p, b->soff);
	*p++ = cpu_to_be32(b->es);
	return 0;
}

static int
nfsd4_block_encode_volume(struct xdr_stream *xdr, struct pnfs_block_volume *b)
{
	__be32 *p;
	int len;

	switch (b->type) {
	case PNFS_BLOCK_VOLUME_SIMPLE:
		len = 4 + 4 + 8 + 4 + b->simple.sig_len;
		p = xdr_reserve_space(xdr, len);
		if (!p)
			return -ETOOSMALL;

		*p++ = cpu_to_be32(b->type);
		*p++ = cpu_to_be32(1);	/* single signature */
		p = xdr_encode_hyper(p, b->simple.offset);
		p = xdr_encode_opaque(p, b->simple.sig, b->simple.sig_len);
		break;
	case PNFS_BLOCK_VOLUME_SCSI:
		len = 4 + 4 + 4 + 4 + b->scsi.designator_len + 8;
		p = xdr_reserve_space(xdr, len);
		if (!p)
			return -ETOOSMALL;

		*p++ = cpu_to_be32(b->type);
		*p++ = cpu_to_be32(b->scsi.code_set);
		*p++ = cpu_to_be32(b->scsi.designator_type);
		p = xdr_encode_opaque(p, b->scsi.designator, b->scsi.designator_len);
		p = xdr_encode_hyper(p, b->scsi.pr_key);
		break;
	default:
		return -ENOTSUPP;
	}

	return len;
}

__be32
nfsd4_block_encode_getdeviceinfo(struct xdr_stream *xdr,
		struct nfsd4_getdeviceinfo *gdp)
{
	struct pnfs_block_deviceaddr *dev = gdp->gd_device;
	int len = sizeof(__be32), ret, i;
	__be32 *p;

	p = xdr_reserve_space(xdr, len + sizeof(__be32));
	if (!p)
		return nfserr_resource;

	for (i = 0; i < dev->nr_volumes; i++) {
		ret = nfsd4_block_encode_volume(xdr, &dev->volumes[i]);
		if (ret < 0)
			return nfserrno(ret);
		len += ret;
	}

	/*
	 * Fill in the overall length and number of volumes at the beginning
	 * of the layout.
	 */
	*p++ = cpu_to_be32(len);
	*p++ = cpu_to_be32(dev->nr_volumes);
	return 0;
}

int
nfsd4_block_decode_layoutupdate(__be32 *p, u32 len, struct iomap **iomapp,
		u32 block_size)
{
	struct iomap *iomaps;
	u32 nr_iomaps, expected, i;

	if (len < sizeof(u32)) {
		dprintk("%s: extent array too small: %u\n", __func__, len);
		return -EINVAL;
	}

	nr_iomaps = be32_to_cpup(p++);
	expected = sizeof(__be32) + nr_iomaps * PNFS_BLOCK_EXTENT_SIZE;
	if (len != expected) {
		dprintk("%s: extent array size mismatch: %u/%u\n",
			__func__, len, expected);
		return -EINVAL;
	}

	iomaps = kcalloc(nr_iomaps, sizeof(*iomaps), GFP_KERNEL);
	if (!iomaps) {
		dprintk("%s: failed to allocate extent array\n", __func__);
		return -ENOMEM;
	}

	for (i = 0; i < nr_iomaps; i++) {
		struct pnfs_block_extent bex;

		memcpy(&bex.vol_id, p, sizeof(struct nfsd4_deviceid));
		p += XDR_QUADLEN(sizeof(struct nfsd4_deviceid));

		p = xdr_decode_hyper(p, &bex.foff);
		if (bex.foff & (block_size - 1)) {
			dprintk("%s: unaligned offset 0x%llx\n",
				__func__, bex.foff);
			goto fail;
		}
		p = xdr_decode_hyper(p, &bex.len);
		if (bex.len & (block_size - 1)) {
			dprintk("%s: unaligned length 0x%llx\n",
				__func__, bex.foff);
			goto fail;
		}
		p = xdr_decode_hyper(p, &bex.soff);
		if (bex.soff & (block_size - 1)) {
			dprintk("%s: unaligned disk offset 0x%llx\n",
				__func__, bex.soff);
			goto fail;
		}
		bex.es = be32_to_cpup(p++);
		if (bex.es != PNFS_BLOCK_READWRITE_DATA) {
			dprintk("%s: incorrect extent state %d\n",
				__func__, bex.es);
			goto fail;
		}

		iomaps[i].offset = bex.foff;
		iomaps[i].length = bex.len;
	}

	*iomapp = iomaps;
	return nr_iomaps;
fail:
	kfree(iomaps);
	return -EINVAL;
}

int
nfsd4_scsi_decode_layoutupdate(__be32 *p, u32 len, struct iomap **iomapp,
		u32 block_size)
{
	struct iomap *iomaps;
	u32 nr_iomaps, expected, i;

	if (len < sizeof(u32)) {
		dprintk("%s: extent array too small: %u\n", __func__, len);
		return -EINVAL;
	}

	nr_iomaps = be32_to_cpup(p++);
	expected = sizeof(__be32) + nr_iomaps * PNFS_SCSI_RANGE_SIZE;
	if (len != expected) {
		dprintk("%s: extent array size mismatch: %u/%u\n",
			__func__, len, expected);
		return -EINVAL;
	}

	iomaps = kcalloc(nr_iomaps, sizeof(*iomaps), GFP_KERNEL);
	if (!iomaps) {
		dprintk("%s: failed to allocate extent array\n", __func__);
		return -ENOMEM;
	}

	for (i = 0; i < nr_iomaps; i++) {
		u64 val;

		p = xdr_decode_hyper(p, &val);
		if (val & (block_size - 1)) {
			dprintk("%s: unaligned offset 0x%llx\n", __func__, val);
			goto fail;
		}
		iomaps[i].offset = val;

		p = xdr_decode_hyper(p, &val);
		if (val & (block_size - 1)) {
			dprintk("%s: unaligned length 0x%llx\n", __func__, val);
			goto fail;
		}
		iomaps[i].length = val;
	}

	*iomapp = iomaps;
	return nr_iomaps;
fail:
	kfree(iomaps);
	return -EINVAL;
}
Commit	Line	Data
8650b8a0	1	/*
f99d4fbd	2	* Copyright (c) 2014-2016 Christoph Hellwig.
8650b8a0 CH	3	*/
	4	#include <linux/sunrpc/svc.h>
	5	#include <linux/exportfs.h>
	6	#include <linux/nfs4.h>
	7
	8	#include "nfsd.h"
	9	#include "blocklayoutxdr.h"
	10
	11	#define NFSDDBG_FACILITY NFSDDBG_PNFS
	12
	13
	14	__be32
	15	nfsd4_block_encode_layoutget(struct xdr_stream *xdr,
	16	struct nfsd4_layoutget *lgp)
	17	{
	18	struct pnfs_block_extent *b = lgp->lg_content;
	19	int len = sizeof(__be32) + 5 * sizeof(__be64) + sizeof(__be32);
	20	__be32 *p;
	21
	22	p = xdr_reserve_space(xdr, sizeof(__be32) + len);
	23	if (!p)
	24	return nfserr_toosmall;
	25
	26	*p++ = cpu_to_be32(len);
	27	p++ = cpu_to_be32(1); / we always return a single extent */
	28
	29	p = xdr_encode_opaque_fixed(p, &b->vol_id,
	30	sizeof(struct nfsd4_deviceid));
	31	p = xdr_encode_hyper(p, b->foff);
	32	p = xdr_encode_hyper(p, b->len);
	33	p = xdr_encode_hyper(p, b->soff);
	34	*p++ = cpu_to_be32(b->es);
	35	return 0;
	36	}
	37
	38	static int
	39	nfsd4_block_encode_volume(struct xdr_stream xdr, struct pnfs_block_volume b)
	40	{
	41	__be32 *p;
	42	int len;
	43
	44	switch (b->type) {
	45	case PNFS_BLOCK_VOLUME_SIMPLE:
	46	len = 4 + 4 + 8 + 4 + b->simple.sig_len;
	47	p = xdr_reserve_space(xdr, len);
	48	if (!p)
	49	return -ETOOSMALL;
	50
	51	*p++ = cpu_to_be32(b->type);
	52	p++ = cpu_to_be32(1); / single signature */
	53	p = xdr_encode_hyper(p, b->simple.offset);
	54	p = xdr_encode_opaque(p, b->simple.sig, b->simple.sig_len);
	55	break;
f99d4fbd CH	56	case PNFS_BLOCK_VOLUME_SCSI:
	57	len = 4 + 4 + 4 + 4 + b->scsi.designator_len + 8;
	58	p = xdr_reserve_space(xdr, len);
	59	if (!p)
	60	return -ETOOSMALL;
	61
	62	*p++ = cpu_to_be32(b->type);
	63	*p++ = cpu_to_be32(b->scsi.code_set);
	64	*p++ = cpu_to_be32(b->scsi.designator_type);
	65	p = xdr_encode_opaque(p, b->scsi.designator, b->scsi.designator_len);
	66	p = xdr_encode_hyper(p, b->scsi.pr_key);
	67	break;
8650b8a0 CH	68	default:
	69	return -ENOTSUPP;
	70	}
	71
	72	return len;
	73	}
	74
	75	__be32
	76	nfsd4_block_encode_getdeviceinfo(struct xdr_stream *xdr,
	77	struct nfsd4_getdeviceinfo *gdp)
	78	{
	79	struct pnfs_block_deviceaddr *dev = gdp->gd_device;
	80	int len = sizeof(__be32), ret, i;
	81	__be32 *p;
	82
	83	p = xdr_reserve_space(xdr, len + sizeof(__be32));
	84	if (!p)
	85	return nfserr_resource;
	86
	87	for (i = 0; i < dev->nr_volumes; i++) {
	88	ret = nfsd4_block_encode_volume(xdr, &dev->volumes[i]);
	89	if (ret < 0)
	90	return nfserrno(ret);
	91	len += ret;
	92	}
	93
	94	/*
	95	* Fill in the overall length and number of volumes at the beginning
	96	* of the layout.
	97	*/
	98	*p++ = cpu_to_be32(len);
	99	*p++ = cpu_to_be32(dev->nr_volumes);
	100	return 0;
	101	}
	102
	103	int
	104	nfsd4_block_decode_layoutupdate(__be32 p, u32 len, struct iomap *iomapp,
	105	u32 block_size)
	106	{
	107	struct iomap *iomaps;
	108	u32 nr_iomaps, expected, i;
	109
	110	if (len < sizeof(u32)) {
	111	dprintk("%s: extent array too small: %u\n", __func__, len);
	112	return -EINVAL;
	113	}
	114
	115	nr_iomaps = be32_to_cpup(p++);
8bb28975	116	expected = sizeof(__be32) + nr_iomaps * PNFS_BLOCK_EXTENT_SIZE;
8650b8a0 CH	117	if (len != expected) {
	118	dprintk("%s: extent array size mismatch: %u/%u\n",
	119	__func__, len, expected);
	120	return -EINVAL;
	121	}
	122
	123	iomaps = kcalloc(nr_iomaps, sizeof(*iomaps), GFP_KERNEL);
	124	if (!iomaps) {
	125	dprintk("%s: failed to allocate extent array\n", __func__);
	126	return -ENOMEM;
	127	}
	128
	129	for (i = 0; i < nr_iomaps; i++) {
	130	struct pnfs_block_extent bex;
	131
	132	memcpy(&bex.vol_id, p, sizeof(struct nfsd4_deviceid));
	133	p += XDR_QUADLEN(sizeof(struct nfsd4_deviceid));
	134
	135	p = xdr_decode_hyper(p, &bex.foff);
	136	if (bex.foff & (block_size - 1)) {
85369523	137	dprintk("%s: unaligned offset 0x%llx\n",
8650b8a0 CH	138	__func__, bex.foff);
	139	goto fail;
	140	}
	141	p = xdr_decode_hyper(p, &bex.len);
	142	if (bex.len & (block_size - 1)) {
85369523	143	dprintk("%s: unaligned length 0x%llx\n",
8650b8a0 CH	144	__func__, bex.foff);
	145	goto fail;
	146	}
	147	p = xdr_decode_hyper(p, &bex.soff);
	148	if (bex.soff & (block_size - 1)) {
85369523	149	dprintk("%s: unaligned disk offset 0x%llx\n",
8650b8a0 CH	150	__func__, bex.soff);
	151	goto fail;
	152	}
	153	bex.es = be32_to_cpup(p++);
	154	if (bex.es != PNFS_BLOCK_READWRITE_DATA) {
	155	dprintk("%s: incorrect extent state %d\n",
	156	__func__, bex.es);
	157	goto fail;
	158	}
	159
	160	iomaps[i].offset = bex.foff;
	161	iomaps[i].length = bex.len;
	162	}
	163
	164	*iomapp = iomaps;
	165	return nr_iomaps;
	166	fail:
	167	kfree(iomaps);
	168	return -EINVAL;
	169	}
f99d4fbd CH	170
	171	int
	172	nfsd4_scsi_decode_layoutupdate(__be32 p, u32 len, struct iomap *iomapp,
	173	u32 block_size)
	174	{
	175	struct iomap *iomaps;
	176	u32 nr_iomaps, expected, i;
	177
	178	if (len < sizeof(u32)) {
	179	dprintk("%s: extent array too small: %u\n", __func__, len);
	180	return -EINVAL;
	181	}
	182
	183	nr_iomaps = be32_to_cpup(p++);
	184	expected = sizeof(__be32) + nr_iomaps * PNFS_SCSI_RANGE_SIZE;
	185	if (len != expected) {
	186	dprintk("%s: extent array size mismatch: %u/%u\n",
	187	__func__, len, expected);
	188	return -EINVAL;
	189	}
	190
	191	iomaps = kcalloc(nr_iomaps, sizeof(*iomaps), GFP_KERNEL);
	192	if (!iomaps) {
	193	dprintk("%s: failed to allocate extent array\n", __func__);
	194	return -ENOMEM;
	195	}
	196
	197	for (i = 0; i < nr_iomaps; i++) {
	198	u64 val;
	199
	200	p = xdr_decode_hyper(p, &val);
	201	if (val & (block_size - 1)) {
	202	dprintk("%s: unaligned offset 0x%llx\n", __func__, val);
	203	goto fail;
	204	}
	205	iomaps[i].offset = val;
	206
	207	p = xdr_decode_hyper(p, &val);
	208	if (val & (block_size - 1)) {
	209	dprintk("%s: unaligned length 0x%llx\n", __func__, val);
	210	goto fail;
	211	}
	212	iomaps[i].length = val;
	213	}
	214
	215	*iomapp = iomaps;
	216	return nr_iomaps;
	217	fail:
	218	kfree(iomaps);
	219	return -EINVAL;
	220	}