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