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 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 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 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 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 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