[linux-block.git] / fs / nfsd / blocklayoutxdr.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2014-2016 Christoph Hellwig.
 */
#include <linux/sunrpc/svc.h>
#include <linux/exportfs.h>
#include <linux/iomap.h>
#include <linux/nfs4.h>

#include "nfsd.h"
#include "blocklayoutxdr.h"
#include "vfs.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 + (XDR_QUADLEN(b->simple.sig_len) << 2);
		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 + (XDR_QUADLEN(b->scsi.designator_len) << 2) + 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, i;

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

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