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, nbytes: 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, ptr: &b->vol_id,
33 len: sizeof(struct nfsd4_deviceid));
34 p = xdr_encode_hyper(p, val: b->foff);
35 p = xdr_encode_hyper(p, val: b->len);
36 p = xdr_encode_hyper(p, val: 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, nbytes: 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, val: b->simple.offset);
57 p = xdr_encode_opaque(p, ptr: b->simple.sig, len: 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, nbytes: 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, ptr: b->scsi.designator, len: b->scsi.designator_len);
69 p = xdr_encode_hyper(p, val: 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, n: 0) != XDR_UNIT)
91 return nfserr_resource;
92 return nfs_ok;
93 }
94
95 p = xdr_reserve_space(xdr, nbytes: 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, b: &dev->volumes[i]);
101 if (ret < 0)
102 return nfserrno(errno: 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: 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(n: nr_iomaps, size: 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, valp: &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, valp: &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, valp: &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: 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(objp: 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: 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(n: nr_iomaps, size: 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, valp: &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, valp: &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(objp: iomaps);
235 return -EINVAL;
236}
237

source code of linux/fs/nfsd/blocklayoutxdr.c