tcp FRTO: SACK variant is errorneously used with NewReno
[linux/fpc-iii.git] / net / sunrpc / xdr.c
blob79a55d56cc980dbe63d1caa913046414e870e926
1 /*
2 * linux/net/sunrpc/xdr.c
4 * Generic XDR support.
6 * Copyright (C) 1995, 1996 Olaf Kirch <okir@monad.swb.de>
7 */
9 #include <linux/module.h>
10 #include <linux/types.h>
11 #include <linux/string.h>
12 #include <linux/kernel.h>
13 #include <linux/pagemap.h>
14 #include <linux/errno.h>
15 #include <linux/sunrpc/xdr.h>
16 #include <linux/sunrpc/msg_prot.h>
19 * XDR functions for basic NFS types
21 __be32 *
22 xdr_encode_netobj(__be32 *p, const struct xdr_netobj *obj)
24 unsigned int quadlen = XDR_QUADLEN(obj->len);
26 p[quadlen] = 0; /* zero trailing bytes */
27 *p++ = htonl(obj->len);
28 memcpy(p, obj->data, obj->len);
29 return p + XDR_QUADLEN(obj->len);
31 EXPORT_SYMBOL(xdr_encode_netobj);
33 __be32 *
34 xdr_decode_netobj(__be32 *p, struct xdr_netobj *obj)
36 unsigned int len;
38 if ((len = ntohl(*p++)) > XDR_MAX_NETOBJ)
39 return NULL;
40 obj->len = len;
41 obj->data = (u8 *) p;
42 return p + XDR_QUADLEN(len);
44 EXPORT_SYMBOL(xdr_decode_netobj);
46 /**
47 * xdr_encode_opaque_fixed - Encode fixed length opaque data
48 * @p: pointer to current position in XDR buffer.
49 * @ptr: pointer to data to encode (or NULL)
50 * @nbytes: size of data.
52 * Copy the array of data of length nbytes at ptr to the XDR buffer
53 * at position p, then align to the next 32-bit boundary by padding
54 * with zero bytes (see RFC1832).
55 * Note: if ptr is NULL, only the padding is performed.
57 * Returns the updated current XDR buffer position
60 __be32 *xdr_encode_opaque_fixed(__be32 *p, const void *ptr, unsigned int nbytes)
62 if (likely(nbytes != 0)) {
63 unsigned int quadlen = XDR_QUADLEN(nbytes);
64 unsigned int padding = (quadlen << 2) - nbytes;
66 if (ptr != NULL)
67 memcpy(p, ptr, nbytes);
68 if (padding != 0)
69 memset((char *)p + nbytes, 0, padding);
70 p += quadlen;
72 return p;
74 EXPORT_SYMBOL(xdr_encode_opaque_fixed);
76 /**
77 * xdr_encode_opaque - Encode variable length opaque data
78 * @p: pointer to current position in XDR buffer.
79 * @ptr: pointer to data to encode (or NULL)
80 * @nbytes: size of data.
82 * Returns the updated current XDR buffer position
84 __be32 *xdr_encode_opaque(__be32 *p, const void *ptr, unsigned int nbytes)
86 *p++ = htonl(nbytes);
87 return xdr_encode_opaque_fixed(p, ptr, nbytes);
89 EXPORT_SYMBOL(xdr_encode_opaque);
91 __be32 *
92 xdr_encode_string(__be32 *p, const char *string)
94 return xdr_encode_array(p, string, strlen(string));
96 EXPORT_SYMBOL(xdr_encode_string);
98 __be32 *
99 xdr_decode_string_inplace(__be32 *p, char **sp,
100 unsigned int *lenp, unsigned int maxlen)
102 u32 len;
104 len = ntohl(*p++);
105 if (len > maxlen)
106 return NULL;
107 *lenp = len;
108 *sp = (char *) p;
109 return p + XDR_QUADLEN(len);
111 EXPORT_SYMBOL(xdr_decode_string_inplace);
113 void
114 xdr_encode_pages(struct xdr_buf *xdr, struct page **pages, unsigned int base,
115 unsigned int len)
117 struct kvec *tail = xdr->tail;
118 u32 *p;
120 xdr->pages = pages;
121 xdr->page_base = base;
122 xdr->page_len = len;
124 p = (u32 *)xdr->head[0].iov_base + XDR_QUADLEN(xdr->head[0].iov_len);
125 tail->iov_base = p;
126 tail->iov_len = 0;
128 if (len & 3) {
129 unsigned int pad = 4 - (len & 3);
131 *p = 0;
132 tail->iov_base = (char *)p + (len & 3);
133 tail->iov_len = pad;
134 len += pad;
136 xdr->buflen += len;
137 xdr->len += len;
139 EXPORT_SYMBOL(xdr_encode_pages);
141 void
142 xdr_inline_pages(struct xdr_buf *xdr, unsigned int offset,
143 struct page **pages, unsigned int base, unsigned int len)
145 struct kvec *head = xdr->head;
146 struct kvec *tail = xdr->tail;
147 char *buf = (char *)head->iov_base;
148 unsigned int buflen = head->iov_len;
150 head->iov_len = offset;
152 xdr->pages = pages;
153 xdr->page_base = base;
154 xdr->page_len = len;
156 tail->iov_base = buf + offset;
157 tail->iov_len = buflen - offset;
159 xdr->buflen += len;
161 EXPORT_SYMBOL(xdr_inline_pages);
164 * Helper routines for doing 'memmove' like operations on a struct xdr_buf
166 * _shift_data_right_pages
167 * @pages: vector of pages containing both the source and dest memory area.
168 * @pgto_base: page vector address of destination
169 * @pgfrom_base: page vector address of source
170 * @len: number of bytes to copy
172 * Note: the addresses pgto_base and pgfrom_base are both calculated in
173 * the same way:
174 * if a memory area starts at byte 'base' in page 'pages[i]',
175 * then its address is given as (i << PAGE_CACHE_SHIFT) + base
176 * Also note: pgfrom_base must be < pgto_base, but the memory areas
177 * they point to may overlap.
179 static void
180 _shift_data_right_pages(struct page **pages, size_t pgto_base,
181 size_t pgfrom_base, size_t len)
183 struct page **pgfrom, **pgto;
184 char *vfrom, *vto;
185 size_t copy;
187 BUG_ON(pgto_base <= pgfrom_base);
189 pgto_base += len;
190 pgfrom_base += len;
192 pgto = pages + (pgto_base >> PAGE_CACHE_SHIFT);
193 pgfrom = pages + (pgfrom_base >> PAGE_CACHE_SHIFT);
195 pgto_base &= ~PAGE_CACHE_MASK;
196 pgfrom_base &= ~PAGE_CACHE_MASK;
198 do {
199 /* Are any pointers crossing a page boundary? */
200 if (pgto_base == 0) {
201 pgto_base = PAGE_CACHE_SIZE;
202 pgto--;
204 if (pgfrom_base == 0) {
205 pgfrom_base = PAGE_CACHE_SIZE;
206 pgfrom--;
209 copy = len;
210 if (copy > pgto_base)
211 copy = pgto_base;
212 if (copy > pgfrom_base)
213 copy = pgfrom_base;
214 pgto_base -= copy;
215 pgfrom_base -= copy;
217 vto = kmap_atomic(*pgto, KM_USER0);
218 vfrom = kmap_atomic(*pgfrom, KM_USER1);
219 memmove(vto + pgto_base, vfrom + pgfrom_base, copy);
220 flush_dcache_page(*pgto);
221 kunmap_atomic(vfrom, KM_USER1);
222 kunmap_atomic(vto, KM_USER0);
224 } while ((len -= copy) != 0);
228 * _copy_to_pages
229 * @pages: array of pages
230 * @pgbase: page vector address of destination
231 * @p: pointer to source data
232 * @len: length
234 * Copies data from an arbitrary memory location into an array of pages
235 * The copy is assumed to be non-overlapping.
237 static void
238 _copy_to_pages(struct page **pages, size_t pgbase, const char *p, size_t len)
240 struct page **pgto;
241 char *vto;
242 size_t copy;
244 pgto = pages + (pgbase >> PAGE_CACHE_SHIFT);
245 pgbase &= ~PAGE_CACHE_MASK;
247 for (;;) {
248 copy = PAGE_CACHE_SIZE - pgbase;
249 if (copy > len)
250 copy = len;
252 vto = kmap_atomic(*pgto, KM_USER0);
253 memcpy(vto + pgbase, p, copy);
254 kunmap_atomic(vto, KM_USER0);
256 len -= copy;
257 if (len == 0)
258 break;
260 pgbase += copy;
261 if (pgbase == PAGE_CACHE_SIZE) {
262 flush_dcache_page(*pgto);
263 pgbase = 0;
264 pgto++;
266 p += copy;
268 flush_dcache_page(*pgto);
272 * _copy_from_pages
273 * @p: pointer to destination
274 * @pages: array of pages
275 * @pgbase: offset of source data
276 * @len: length
278 * Copies data into an arbitrary memory location from an array of pages
279 * The copy is assumed to be non-overlapping.
281 static void
282 _copy_from_pages(char *p, struct page **pages, size_t pgbase, size_t len)
284 struct page **pgfrom;
285 char *vfrom;
286 size_t copy;
288 pgfrom = pages + (pgbase >> PAGE_CACHE_SHIFT);
289 pgbase &= ~PAGE_CACHE_MASK;
291 do {
292 copy = PAGE_CACHE_SIZE - pgbase;
293 if (copy > len)
294 copy = len;
296 vfrom = kmap_atomic(*pgfrom, KM_USER0);
297 memcpy(p, vfrom + pgbase, copy);
298 kunmap_atomic(vfrom, KM_USER0);
300 pgbase += copy;
301 if (pgbase == PAGE_CACHE_SIZE) {
302 pgbase = 0;
303 pgfrom++;
305 p += copy;
307 } while ((len -= copy) != 0);
311 * xdr_shrink_bufhead
312 * @buf: xdr_buf
313 * @len: bytes to remove from buf->head[0]
315 * Shrinks XDR buffer's header kvec buf->head[0] by
316 * 'len' bytes. The extra data is not lost, but is instead
317 * moved into the inlined pages and/or the tail.
319 static void
320 xdr_shrink_bufhead(struct xdr_buf *buf, size_t len)
322 struct kvec *head, *tail;
323 size_t copy, offs;
324 unsigned int pglen = buf->page_len;
326 tail = buf->tail;
327 head = buf->head;
328 BUG_ON (len > head->iov_len);
330 /* Shift the tail first */
331 if (tail->iov_len != 0) {
332 if (tail->iov_len > len) {
333 copy = tail->iov_len - len;
334 memmove((char *)tail->iov_base + len,
335 tail->iov_base, copy);
337 /* Copy from the inlined pages into the tail */
338 copy = len;
339 if (copy > pglen)
340 copy = pglen;
341 offs = len - copy;
342 if (offs >= tail->iov_len)
343 copy = 0;
344 else if (copy > tail->iov_len - offs)
345 copy = tail->iov_len - offs;
346 if (copy != 0)
347 _copy_from_pages((char *)tail->iov_base + offs,
348 buf->pages,
349 buf->page_base + pglen + offs - len,
350 copy);
351 /* Do we also need to copy data from the head into the tail ? */
352 if (len > pglen) {
353 offs = copy = len - pglen;
354 if (copy > tail->iov_len)
355 copy = tail->iov_len;
356 memcpy(tail->iov_base,
357 (char *)head->iov_base +
358 head->iov_len - offs,
359 copy);
362 /* Now handle pages */
363 if (pglen != 0) {
364 if (pglen > len)
365 _shift_data_right_pages(buf->pages,
366 buf->page_base + len,
367 buf->page_base,
368 pglen - len);
369 copy = len;
370 if (len > pglen)
371 copy = pglen;
372 _copy_to_pages(buf->pages, buf->page_base,
373 (char *)head->iov_base + head->iov_len - len,
374 copy);
376 head->iov_len -= len;
377 buf->buflen -= len;
378 /* Have we truncated the message? */
379 if (buf->len > buf->buflen)
380 buf->len = buf->buflen;
384 * xdr_shrink_pagelen
385 * @buf: xdr_buf
386 * @len: bytes to remove from buf->pages
388 * Shrinks XDR buffer's page array buf->pages by
389 * 'len' bytes. The extra data is not lost, but is instead
390 * moved into the tail.
392 static void
393 xdr_shrink_pagelen(struct xdr_buf *buf, size_t len)
395 struct kvec *tail;
396 size_t copy;
397 char *p;
398 unsigned int pglen = buf->page_len;
400 tail = buf->tail;
401 BUG_ON (len > pglen);
403 /* Shift the tail first */
404 if (tail->iov_len != 0) {
405 p = (char *)tail->iov_base + len;
406 if (tail->iov_len > len) {
407 copy = tail->iov_len - len;
408 memmove(p, tail->iov_base, copy);
409 } else
410 buf->buflen -= len;
411 /* Copy from the inlined pages into the tail */
412 copy = len;
413 if (copy > tail->iov_len)
414 copy = tail->iov_len;
415 _copy_from_pages((char *)tail->iov_base,
416 buf->pages, buf->page_base + pglen - len,
417 copy);
419 buf->page_len -= len;
420 buf->buflen -= len;
421 /* Have we truncated the message? */
422 if (buf->len > buf->buflen)
423 buf->len = buf->buflen;
426 void
427 xdr_shift_buf(struct xdr_buf *buf, size_t len)
429 xdr_shrink_bufhead(buf, len);
431 EXPORT_SYMBOL(xdr_shift_buf);
434 * xdr_init_encode - Initialize a struct xdr_stream for sending data.
435 * @xdr: pointer to xdr_stream struct
436 * @buf: pointer to XDR buffer in which to encode data
437 * @p: current pointer inside XDR buffer
439 * Note: at the moment the RPC client only passes the length of our
440 * scratch buffer in the xdr_buf's header kvec. Previously this
441 * meant we needed to call xdr_adjust_iovec() after encoding the
442 * data. With the new scheme, the xdr_stream manages the details
443 * of the buffer length, and takes care of adjusting the kvec
444 * length for us.
446 void xdr_init_encode(struct xdr_stream *xdr, struct xdr_buf *buf, __be32 *p)
448 struct kvec *iov = buf->head;
449 int scratch_len = buf->buflen - buf->page_len - buf->tail[0].iov_len;
451 BUG_ON(scratch_len < 0);
452 xdr->buf = buf;
453 xdr->iov = iov;
454 xdr->p = (__be32 *)((char *)iov->iov_base + iov->iov_len);
455 xdr->end = (__be32 *)((char *)iov->iov_base + scratch_len);
456 BUG_ON(iov->iov_len > scratch_len);
458 if (p != xdr->p && p != NULL) {
459 size_t len;
461 BUG_ON(p < xdr->p || p > xdr->end);
462 len = (char *)p - (char *)xdr->p;
463 xdr->p = p;
464 buf->len += len;
465 iov->iov_len += len;
468 EXPORT_SYMBOL(xdr_init_encode);
471 * xdr_reserve_space - Reserve buffer space for sending
472 * @xdr: pointer to xdr_stream
473 * @nbytes: number of bytes to reserve
475 * Checks that we have enough buffer space to encode 'nbytes' more
476 * bytes of data. If so, update the total xdr_buf length, and
477 * adjust the length of the current kvec.
479 __be32 * xdr_reserve_space(struct xdr_stream *xdr, size_t nbytes)
481 __be32 *p = xdr->p;
482 __be32 *q;
484 /* align nbytes on the next 32-bit boundary */
485 nbytes += 3;
486 nbytes &= ~3;
487 q = p + (nbytes >> 2);
488 if (unlikely(q > xdr->end || q < p))
489 return NULL;
490 xdr->p = q;
491 xdr->iov->iov_len += nbytes;
492 xdr->buf->len += nbytes;
493 return p;
495 EXPORT_SYMBOL(xdr_reserve_space);
498 * xdr_write_pages - Insert a list of pages into an XDR buffer for sending
499 * @xdr: pointer to xdr_stream
500 * @pages: list of pages
501 * @base: offset of first byte
502 * @len: length of data in bytes
505 void xdr_write_pages(struct xdr_stream *xdr, struct page **pages, unsigned int base,
506 unsigned int len)
508 struct xdr_buf *buf = xdr->buf;
509 struct kvec *iov = buf->tail;
510 buf->pages = pages;
511 buf->page_base = base;
512 buf->page_len = len;
514 iov->iov_base = (char *)xdr->p;
515 iov->iov_len = 0;
516 xdr->iov = iov;
518 if (len & 3) {
519 unsigned int pad = 4 - (len & 3);
521 BUG_ON(xdr->p >= xdr->end);
522 iov->iov_base = (char *)xdr->p + (len & 3);
523 iov->iov_len += pad;
524 len += pad;
525 *xdr->p++ = 0;
527 buf->buflen += len;
528 buf->len += len;
530 EXPORT_SYMBOL(xdr_write_pages);
533 * xdr_init_decode - Initialize an xdr_stream for decoding data.
534 * @xdr: pointer to xdr_stream struct
535 * @buf: pointer to XDR buffer from which to decode data
536 * @p: current pointer inside XDR buffer
538 void xdr_init_decode(struct xdr_stream *xdr, struct xdr_buf *buf, __be32 *p)
540 struct kvec *iov = buf->head;
541 unsigned int len = iov->iov_len;
543 if (len > buf->len)
544 len = buf->len;
545 xdr->buf = buf;
546 xdr->iov = iov;
547 xdr->p = p;
548 xdr->end = (__be32 *)((char *)iov->iov_base + len);
550 EXPORT_SYMBOL(xdr_init_decode);
553 * xdr_inline_decode - Retrieve non-page XDR data to decode
554 * @xdr: pointer to xdr_stream struct
555 * @nbytes: number of bytes of data to decode
557 * Check if the input buffer is long enough to enable us to decode
558 * 'nbytes' more bytes of data starting at the current position.
559 * If so return the current pointer, then update the current
560 * pointer position.
562 __be32 * xdr_inline_decode(struct xdr_stream *xdr, size_t nbytes)
564 __be32 *p = xdr->p;
565 __be32 *q = p + XDR_QUADLEN(nbytes);
567 if (unlikely(q > xdr->end || q < p))
568 return NULL;
569 xdr->p = q;
570 return p;
572 EXPORT_SYMBOL(xdr_inline_decode);
575 * xdr_read_pages - Ensure page-based XDR data to decode is aligned at current pointer position
576 * @xdr: pointer to xdr_stream struct
577 * @len: number of bytes of page data
579 * Moves data beyond the current pointer position from the XDR head[] buffer
580 * into the page list. Any data that lies beyond current position + "len"
581 * bytes is moved into the XDR tail[].
583 void xdr_read_pages(struct xdr_stream *xdr, unsigned int len)
585 struct xdr_buf *buf = xdr->buf;
586 struct kvec *iov;
587 ssize_t shift;
588 unsigned int end;
589 int padding;
591 /* Realign pages to current pointer position */
592 iov = buf->head;
593 shift = iov->iov_len + (char *)iov->iov_base - (char *)xdr->p;
594 if (shift > 0)
595 xdr_shrink_bufhead(buf, shift);
597 /* Truncate page data and move it into the tail */
598 if (buf->page_len > len)
599 xdr_shrink_pagelen(buf, buf->page_len - len);
600 padding = (XDR_QUADLEN(len) << 2) - len;
601 xdr->iov = iov = buf->tail;
602 /* Compute remaining message length. */
603 end = iov->iov_len;
604 shift = buf->buflen - buf->len;
605 if (shift < end)
606 end -= shift;
607 else if (shift > 0)
608 end = 0;
610 * Position current pointer at beginning of tail, and
611 * set remaining message length.
613 xdr->p = (__be32 *)((char *)iov->iov_base + padding);
614 xdr->end = (__be32 *)((char *)iov->iov_base + end);
616 EXPORT_SYMBOL(xdr_read_pages);
619 * xdr_enter_page - decode data from the XDR page
620 * @xdr: pointer to xdr_stream struct
621 * @len: number of bytes of page data
623 * Moves data beyond the current pointer position from the XDR head[] buffer
624 * into the page list. Any data that lies beyond current position + "len"
625 * bytes is moved into the XDR tail[]. The current pointer is then
626 * repositioned at the beginning of the first XDR page.
628 void xdr_enter_page(struct xdr_stream *xdr, unsigned int len)
630 char * kaddr = page_address(xdr->buf->pages[0]);
631 xdr_read_pages(xdr, len);
633 * Position current pointer at beginning of tail, and
634 * set remaining message length.
636 if (len > PAGE_CACHE_SIZE - xdr->buf->page_base)
637 len = PAGE_CACHE_SIZE - xdr->buf->page_base;
638 xdr->p = (__be32 *)(kaddr + xdr->buf->page_base);
639 xdr->end = (__be32 *)((char *)xdr->p + len);
641 EXPORT_SYMBOL(xdr_enter_page);
643 static struct kvec empty_iov = {.iov_base = NULL, .iov_len = 0};
645 void
646 xdr_buf_from_iov(struct kvec *iov, struct xdr_buf *buf)
648 buf->head[0] = *iov;
649 buf->tail[0] = empty_iov;
650 buf->page_len = 0;
651 buf->buflen = buf->len = iov->iov_len;
653 EXPORT_SYMBOL(xdr_buf_from_iov);
655 /* Sets subbuf to the portion of buf of length len beginning base bytes
656 * from the start of buf. Returns -1 if base of length are out of bounds. */
658 xdr_buf_subsegment(struct xdr_buf *buf, struct xdr_buf *subbuf,
659 unsigned int base, unsigned int len)
661 subbuf->buflen = subbuf->len = len;
662 if (base < buf->head[0].iov_len) {
663 subbuf->head[0].iov_base = buf->head[0].iov_base + base;
664 subbuf->head[0].iov_len = min_t(unsigned int, len,
665 buf->head[0].iov_len - base);
666 len -= subbuf->head[0].iov_len;
667 base = 0;
668 } else {
669 subbuf->head[0].iov_base = NULL;
670 subbuf->head[0].iov_len = 0;
671 base -= buf->head[0].iov_len;
674 if (base < buf->page_len) {
675 subbuf->page_len = min(buf->page_len - base, len);
676 base += buf->page_base;
677 subbuf->page_base = base & ~PAGE_CACHE_MASK;
678 subbuf->pages = &buf->pages[base >> PAGE_CACHE_SHIFT];
679 len -= subbuf->page_len;
680 base = 0;
681 } else {
682 base -= buf->page_len;
683 subbuf->page_len = 0;
686 if (base < buf->tail[0].iov_len) {
687 subbuf->tail[0].iov_base = buf->tail[0].iov_base + base;
688 subbuf->tail[0].iov_len = min_t(unsigned int, len,
689 buf->tail[0].iov_len - base);
690 len -= subbuf->tail[0].iov_len;
691 base = 0;
692 } else {
693 subbuf->tail[0].iov_base = NULL;
694 subbuf->tail[0].iov_len = 0;
695 base -= buf->tail[0].iov_len;
698 if (base || len)
699 return -1;
700 return 0;
702 EXPORT_SYMBOL(xdr_buf_subsegment);
704 static void __read_bytes_from_xdr_buf(struct xdr_buf *subbuf, void *obj, unsigned int len)
706 unsigned int this_len;
708 this_len = min_t(unsigned int, len, subbuf->head[0].iov_len);
709 memcpy(obj, subbuf->head[0].iov_base, this_len);
710 len -= this_len;
711 obj += this_len;
712 this_len = min_t(unsigned int, len, subbuf->page_len);
713 if (this_len)
714 _copy_from_pages(obj, subbuf->pages, subbuf->page_base, this_len);
715 len -= this_len;
716 obj += this_len;
717 this_len = min_t(unsigned int, len, subbuf->tail[0].iov_len);
718 memcpy(obj, subbuf->tail[0].iov_base, this_len);
721 /* obj is assumed to point to allocated memory of size at least len: */
722 int read_bytes_from_xdr_buf(struct xdr_buf *buf, unsigned int base, void *obj, unsigned int len)
724 struct xdr_buf subbuf;
725 int status;
727 status = xdr_buf_subsegment(buf, &subbuf, base, len);
728 if (status != 0)
729 return status;
730 __read_bytes_from_xdr_buf(&subbuf, obj, len);
731 return 0;
733 EXPORT_SYMBOL(read_bytes_from_xdr_buf);
735 static void __write_bytes_to_xdr_buf(struct xdr_buf *subbuf, void *obj, unsigned int len)
737 unsigned int this_len;
739 this_len = min_t(unsigned int, len, subbuf->head[0].iov_len);
740 memcpy(subbuf->head[0].iov_base, obj, this_len);
741 len -= this_len;
742 obj += this_len;
743 this_len = min_t(unsigned int, len, subbuf->page_len);
744 if (this_len)
745 _copy_to_pages(subbuf->pages, subbuf->page_base, obj, this_len);
746 len -= this_len;
747 obj += this_len;
748 this_len = min_t(unsigned int, len, subbuf->tail[0].iov_len);
749 memcpy(subbuf->tail[0].iov_base, obj, this_len);
752 /* obj is assumed to point to allocated memory of size at least len: */
753 int write_bytes_to_xdr_buf(struct xdr_buf *buf, unsigned int base, void *obj, unsigned int len)
755 struct xdr_buf subbuf;
756 int status;
758 status = xdr_buf_subsegment(buf, &subbuf, base, len);
759 if (status != 0)
760 return status;
761 __write_bytes_to_xdr_buf(&subbuf, obj, len);
762 return 0;
766 xdr_decode_word(struct xdr_buf *buf, unsigned int base, u32 *obj)
768 __be32 raw;
769 int status;
771 status = read_bytes_from_xdr_buf(buf, base, &raw, sizeof(*obj));
772 if (status)
773 return status;
774 *obj = ntohl(raw);
775 return 0;
777 EXPORT_SYMBOL(xdr_decode_word);
780 xdr_encode_word(struct xdr_buf *buf, unsigned int base, u32 obj)
782 __be32 raw = htonl(obj);
784 return write_bytes_to_xdr_buf(buf, base, &raw, sizeof(obj));
786 EXPORT_SYMBOL(xdr_encode_word);
788 /* If the netobj starting offset bytes from the start of xdr_buf is contained
789 * entirely in the head or the tail, set object to point to it; otherwise
790 * try to find space for it at the end of the tail, copy it there, and
791 * set obj to point to it. */
792 int xdr_buf_read_netobj(struct xdr_buf *buf, struct xdr_netobj *obj, unsigned int offset)
794 struct xdr_buf subbuf;
796 if (xdr_decode_word(buf, offset, &obj->len))
797 return -EFAULT;
798 if (xdr_buf_subsegment(buf, &subbuf, offset + 4, obj->len))
799 return -EFAULT;
801 /* Is the obj contained entirely in the head? */
802 obj->data = subbuf.head[0].iov_base;
803 if (subbuf.head[0].iov_len == obj->len)
804 return 0;
805 /* ..or is the obj contained entirely in the tail? */
806 obj->data = subbuf.tail[0].iov_base;
807 if (subbuf.tail[0].iov_len == obj->len)
808 return 0;
810 /* use end of tail as storage for obj:
811 * (We don't copy to the beginning because then we'd have
812 * to worry about doing a potentially overlapping copy.
813 * This assumes the object is at most half the length of the
814 * tail.) */
815 if (obj->len > buf->buflen - buf->len)
816 return -ENOMEM;
817 if (buf->tail[0].iov_len != 0)
818 obj->data = buf->tail[0].iov_base + buf->tail[0].iov_len;
819 else
820 obj->data = buf->head[0].iov_base + buf->head[0].iov_len;
821 __read_bytes_from_xdr_buf(&subbuf, obj->data, obj->len);
822 return 0;
824 EXPORT_SYMBOL(xdr_buf_read_netobj);
826 /* Returns 0 on success, or else a negative error code. */
827 static int
828 xdr_xcode_array2(struct xdr_buf *buf, unsigned int base,
829 struct xdr_array2_desc *desc, int encode)
831 char *elem = NULL, *c;
832 unsigned int copied = 0, todo, avail_here;
833 struct page **ppages = NULL;
834 int err;
836 if (encode) {
837 if (xdr_encode_word(buf, base, desc->array_len) != 0)
838 return -EINVAL;
839 } else {
840 if (xdr_decode_word(buf, base, &desc->array_len) != 0 ||
841 desc->array_len > desc->array_maxlen ||
842 (unsigned long) base + 4 + desc->array_len *
843 desc->elem_size > buf->len)
844 return -EINVAL;
846 base += 4;
848 if (!desc->xcode)
849 return 0;
851 todo = desc->array_len * desc->elem_size;
853 /* process head */
854 if (todo && base < buf->head->iov_len) {
855 c = buf->head->iov_base + base;
856 avail_here = min_t(unsigned int, todo,
857 buf->head->iov_len - base);
858 todo -= avail_here;
860 while (avail_here >= desc->elem_size) {
861 err = desc->xcode(desc, c);
862 if (err)
863 goto out;
864 c += desc->elem_size;
865 avail_here -= desc->elem_size;
867 if (avail_here) {
868 if (!elem) {
869 elem = kmalloc(desc->elem_size, GFP_KERNEL);
870 err = -ENOMEM;
871 if (!elem)
872 goto out;
874 if (encode) {
875 err = desc->xcode(desc, elem);
876 if (err)
877 goto out;
878 memcpy(c, elem, avail_here);
879 } else
880 memcpy(elem, c, avail_here);
881 copied = avail_here;
883 base = buf->head->iov_len; /* align to start of pages */
886 /* process pages array */
887 base -= buf->head->iov_len;
888 if (todo && base < buf->page_len) {
889 unsigned int avail_page;
891 avail_here = min(todo, buf->page_len - base);
892 todo -= avail_here;
894 base += buf->page_base;
895 ppages = buf->pages + (base >> PAGE_CACHE_SHIFT);
896 base &= ~PAGE_CACHE_MASK;
897 avail_page = min_t(unsigned int, PAGE_CACHE_SIZE - base,
898 avail_here);
899 c = kmap(*ppages) + base;
901 while (avail_here) {
902 avail_here -= avail_page;
903 if (copied || avail_page < desc->elem_size) {
904 unsigned int l = min(avail_page,
905 desc->elem_size - copied);
906 if (!elem) {
907 elem = kmalloc(desc->elem_size,
908 GFP_KERNEL);
909 err = -ENOMEM;
910 if (!elem)
911 goto out;
913 if (encode) {
914 if (!copied) {
915 err = desc->xcode(desc, elem);
916 if (err)
917 goto out;
919 memcpy(c, elem + copied, l);
920 copied += l;
921 if (copied == desc->elem_size)
922 copied = 0;
923 } else {
924 memcpy(elem + copied, c, l);
925 copied += l;
926 if (copied == desc->elem_size) {
927 err = desc->xcode(desc, elem);
928 if (err)
929 goto out;
930 copied = 0;
933 avail_page -= l;
934 c += l;
936 while (avail_page >= desc->elem_size) {
937 err = desc->xcode(desc, c);
938 if (err)
939 goto out;
940 c += desc->elem_size;
941 avail_page -= desc->elem_size;
943 if (avail_page) {
944 unsigned int l = min(avail_page,
945 desc->elem_size - copied);
946 if (!elem) {
947 elem = kmalloc(desc->elem_size,
948 GFP_KERNEL);
949 err = -ENOMEM;
950 if (!elem)
951 goto out;
953 if (encode) {
954 if (!copied) {
955 err = desc->xcode(desc, elem);
956 if (err)
957 goto out;
959 memcpy(c, elem + copied, l);
960 copied += l;
961 if (copied == desc->elem_size)
962 copied = 0;
963 } else {
964 memcpy(elem + copied, c, l);
965 copied += l;
966 if (copied == desc->elem_size) {
967 err = desc->xcode(desc, elem);
968 if (err)
969 goto out;
970 copied = 0;
974 if (avail_here) {
975 kunmap(*ppages);
976 ppages++;
977 c = kmap(*ppages);
980 avail_page = min(avail_here,
981 (unsigned int) PAGE_CACHE_SIZE);
983 base = buf->page_len; /* align to start of tail */
986 /* process tail */
987 base -= buf->page_len;
988 if (todo) {
989 c = buf->tail->iov_base + base;
990 if (copied) {
991 unsigned int l = desc->elem_size - copied;
993 if (encode)
994 memcpy(c, elem + copied, l);
995 else {
996 memcpy(elem + copied, c, l);
997 err = desc->xcode(desc, elem);
998 if (err)
999 goto out;
1001 todo -= l;
1002 c += l;
1004 while (todo) {
1005 err = desc->xcode(desc, c);
1006 if (err)
1007 goto out;
1008 c += desc->elem_size;
1009 todo -= desc->elem_size;
1012 err = 0;
1014 out:
1015 kfree(elem);
1016 if (ppages)
1017 kunmap(*ppages);
1018 return err;
1022 xdr_decode_array2(struct xdr_buf *buf, unsigned int base,
1023 struct xdr_array2_desc *desc)
1025 if (base >= buf->len)
1026 return -EINVAL;
1028 return xdr_xcode_array2(buf, base, desc, 0);
1030 EXPORT_SYMBOL(xdr_decode_array2);
1033 xdr_encode_array2(struct xdr_buf *buf, unsigned int base,
1034 struct xdr_array2_desc *desc)
1036 if ((unsigned long) base + 4 + desc->array_len * desc->elem_size >
1037 buf->head->iov_len + buf->page_len + buf->tail->iov_len)
1038 return -EINVAL;
1040 return xdr_xcode_array2(buf, base, desc, 1);
1042 EXPORT_SYMBOL(xdr_encode_array2);
1045 xdr_process_buf(struct xdr_buf *buf, unsigned int offset, unsigned int len,
1046 int (*actor)(struct scatterlist *, void *), void *data)
1048 int i, ret = 0;
1049 unsigned page_len, thislen, page_offset;
1050 struct scatterlist sg[1];
1052 sg_init_table(sg, 1);
1054 if (offset >= buf->head[0].iov_len) {
1055 offset -= buf->head[0].iov_len;
1056 } else {
1057 thislen = buf->head[0].iov_len - offset;
1058 if (thislen > len)
1059 thislen = len;
1060 sg_set_buf(sg, buf->head[0].iov_base + offset, thislen);
1061 ret = actor(sg, data);
1062 if (ret)
1063 goto out;
1064 offset = 0;
1065 len -= thislen;
1067 if (len == 0)
1068 goto out;
1070 if (offset >= buf->page_len) {
1071 offset -= buf->page_len;
1072 } else {
1073 page_len = buf->page_len - offset;
1074 if (page_len > len)
1075 page_len = len;
1076 len -= page_len;
1077 page_offset = (offset + buf->page_base) & (PAGE_CACHE_SIZE - 1);
1078 i = (offset + buf->page_base) >> PAGE_CACHE_SHIFT;
1079 thislen = PAGE_CACHE_SIZE - page_offset;
1080 do {
1081 if (thislen > page_len)
1082 thislen = page_len;
1083 sg_set_page(sg, buf->pages[i], thislen, page_offset);
1084 ret = actor(sg, data);
1085 if (ret)
1086 goto out;
1087 page_len -= thislen;
1088 i++;
1089 page_offset = 0;
1090 thislen = PAGE_CACHE_SIZE;
1091 } while (page_len != 0);
1092 offset = 0;
1094 if (len == 0)
1095 goto out;
1096 if (offset < buf->tail[0].iov_len) {
1097 thislen = buf->tail[0].iov_len - offset;
1098 if (thislen > len)
1099 thislen = len;
1100 sg_set_buf(sg, buf->tail[0].iov_base + offset, thislen);
1101 ret = actor(sg, data);
1102 len -= thislen;
1104 if (len != 0)
1105 ret = -EINVAL;
1106 out:
1107 return ret;
1109 EXPORT_SYMBOL(xdr_process_buf);