blocklayoutxdr.c 5.2 KB

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