1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Copyright (c) 2014-2016 Christoph Hellwig.
4 */
5#include <linux/sunrpc/svc.h>
6#include <linux/exportfs.h>
7#include <linux/iomap.h>
8#include <linux/nfs4.h>
9
10#include "nfsd.h"
11#include "blocklayoutxdr.h"
12#include "vfs.h"
13
14#define NFSDDBG_FACILITY	NFSDDBG_PNFS
15
16
17__be32
18nfsd4_block_encode_layoutget(struct xdr_stream *xdr,
19		const struct nfsd4_layoutget *lgp)
20{
21	const 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
41static int
42nfsd4_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:
49		len = 4 + 4 + 8 + 4 + (XDR_QUADLEN(b->simple.sig_len) << 2);
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;
59	case PNFS_BLOCK_VOLUME_SCSI:
60		len = 4 + 4 + 4 + 4 + (XDR_QUADLEN(b->scsi.designator_len) << 2) + 8;
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;
71	default:
72		return -ENOTSUPP;
73	}
74
75	return len;
76}
77
78__be32
79nfsd4_block_encode_getdeviceinfo(struct xdr_stream *xdr,
80		const 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	/*
87	 * See paragraph 5 of RFC 8881 S18.40.3.
88	 */
89	if (!gdp->gd_maxcount) {
90		if (xdr_stream_encode_u32(xdr, 0) != XDR_UNIT)
91			return nfserr_resource;
92		return nfs_ok;
93	}
94
95	p = xdr_reserve_space(xdr, len + sizeof(__be32));
96	if (!p)
97		return nfserr_resource;
98
99	for (i = 0; i < dev->nr_volumes; i++) {
100		ret = nfsd4_block_encode_volume(xdr, &dev->volumes[i]);
101		if (ret < 0)
102			return nfserrno(ret);
103		len += ret;
104	}
105
106	/*
107	 * Fill in the overall length and number of volumes at the beginning
108	 * of the layout.
109	 */
110	*p++ = cpu_to_be32(len);
111	*p++ = cpu_to_be32(dev->nr_volumes);
112	return 0;
113}
114
115int
116nfsd4_block_decode_layoutupdate(__be32 *p, u32 len, struct iomap **iomapp,
117		u32 block_size)
118{
119	struct iomap *iomaps;
120	u32 nr_iomaps, i;
121
122	if (len < sizeof(u32)) {
123		dprintk("%s: extent array too small: %u\n", __func__, len);
124		return -EINVAL;
125	}
126	len -= sizeof(u32);
127	if (len % PNFS_BLOCK_EXTENT_SIZE) {
128		dprintk("%s: extent array invalid: %u\n", __func__, len);
129		return -EINVAL;
130	}
131
132	nr_iomaps = be32_to_cpup(p++);
133	if (nr_iomaps != len / PNFS_BLOCK_EXTENT_SIZE) {
134		dprintk("%s: extent array size mismatch: %u/%u\n",
135			__func__, len, nr_iomaps);
136		return -EINVAL;
137	}
138
139	iomaps = kcalloc(nr_iomaps, sizeof(*iomaps), GFP_KERNEL);
140	if (!iomaps) {
141		dprintk("%s: failed to allocate extent array\n", __func__);
142		return -ENOMEM;
143	}
144
145	for (i = 0; i < nr_iomaps; i++) {
146		struct pnfs_block_extent bex;
147
148		memcpy(&bex.vol_id, p, sizeof(struct nfsd4_deviceid));
149		p += XDR_QUADLEN(sizeof(struct nfsd4_deviceid));
150
151		p = xdr_decode_hyper(p, &bex.foff);
152		if (bex.foff & (block_size - 1)) {
153			dprintk("%s: unaligned offset 0x%llx\n",
154				__func__, bex.foff);
155			goto fail;
156		}
157		p = xdr_decode_hyper(p, &bex.len);
158		if (bex.len & (block_size - 1)) {
159			dprintk("%s: unaligned length 0x%llx\n",
160				__func__, bex.foff);
161			goto fail;
162		}
163		p = xdr_decode_hyper(p, &bex.soff);
164		if (bex.soff & (block_size - 1)) {
165			dprintk("%s: unaligned disk offset 0x%llx\n",
166				__func__, bex.soff);
167			goto fail;
168		}
169		bex.es = be32_to_cpup(p++);
170		if (bex.es != PNFS_BLOCK_READWRITE_DATA) {
171			dprintk("%s: incorrect extent state %d\n",
172				__func__, bex.es);
173			goto fail;
174		}
175
176		iomaps[i].offset = bex.foff;
177		iomaps[i].length = bex.len;
178	}
179
180	*iomapp = iomaps;
181	return nr_iomaps;
182fail:
183	kfree(iomaps);
184	return -EINVAL;
185}
186
187int
188nfsd4_scsi_decode_layoutupdate(__be32 *p, u32 len, struct iomap **iomapp,
189		u32 block_size)
190{
191	struct iomap *iomaps;
192	u32 nr_iomaps, expected, i;
193
194	if (len < sizeof(u32)) {
195		dprintk("%s: extent array too small: %u\n", __func__, len);
196		return -EINVAL;
197	}
198
199	nr_iomaps = be32_to_cpup(p++);
200	expected = sizeof(__be32) + nr_iomaps * PNFS_SCSI_RANGE_SIZE;
201	if (len != expected) {
202		dprintk("%s: extent array size mismatch: %u/%u\n",
203			__func__, len, expected);
204		return -EINVAL;
205	}
206
207	iomaps = kcalloc(nr_iomaps, sizeof(*iomaps), GFP_KERNEL);
208	if (!iomaps) {
209		dprintk("%s: failed to allocate extent array\n", __func__);
210		return -ENOMEM;
211	}
212
213	for (i = 0; i < nr_iomaps; i++) {
214		u64 val;
215
216		p = xdr_decode_hyper(p, &val);
217		if (val & (block_size - 1)) {
218			dprintk("%s: unaligned offset 0x%llx\n", __func__, val);
219			goto fail;
220		}
221		iomaps[i].offset = val;
222
223		p = xdr_decode_hyper(p, &val);
224		if (val & (block_size - 1)) {
225			dprintk("%s: unaligned length 0x%llx\n", __func__, val);
226			goto fail;
227		}
228		iomaps[i].length = val;
229	}
230
231	*iomapp = iomaps;
232	return nr_iomaps;
233fail:
234	kfree(iomaps);
235	return -EINVAL;
236}
237