]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/kern/subr_sbuf.c
Merge bmake-20220204
[FreeBSD/FreeBSD.git] / sys / kern / subr_sbuf.c
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 2000-2008 Poul-Henning Kamp
5  * Copyright (c) 2000-2008 Dag-Erling Coïdan Smørgrav
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer
13  *    in this position and unchanged.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28  * SUCH DAMAGE.
29  */
30
31 #include <sys/cdefs.h>
32 __FBSDID("$FreeBSD$");
33
34 #include <sys/param.h>
35
36 #ifdef _KERNEL
37 #include <sys/ctype.h>
38 #include <sys/errno.h>
39 #include <sys/kernel.h>
40 #include <sys/limits.h>
41 #include <sys/malloc.h>
42 #include <sys/systm.h>
43 #include <sys/uio.h>
44 #include <machine/stdarg.h>
45 #else /* _KERNEL */
46 #include <ctype.h>
47 #include <errno.h>
48 #include <limits.h>
49 #include <stdarg.h>
50 #include <stdio.h>
51 #include <stdlib.h>
52 #include <string.h>
53 #endif /* _KERNEL */
54
55 #include <sys/sbuf.h>
56
57 #ifdef _KERNEL
58 static MALLOC_DEFINE(M_SBUF, "sbuf", "string buffers");
59 #define SBMALLOC(size, flags)   malloc(size, M_SBUF, (flags) | M_ZERO)
60 #define SBFREE(buf)             free(buf, M_SBUF)
61 #else /* _KERNEL */
62 #define KASSERT(e, m)
63 #define SBMALLOC(size, flags)   calloc(1, size)
64 #define SBFREE(buf)             free(buf)
65 #endif /* _KERNEL */
66
67 /*
68  * Predicates
69  */
70 #define SBUF_ISDYNAMIC(s)       ((s)->s_flags & SBUF_DYNAMIC)
71 #define SBUF_ISDYNSTRUCT(s)     ((s)->s_flags & SBUF_DYNSTRUCT)
72 #define SBUF_ISFINISHED(s)      ((s)->s_flags & SBUF_FINISHED)
73 #define SBUF_ISDRAINATEOL(s)    ((s)->s_flags & SBUF_DRAINATEOL)
74 #define SBUF_HASROOM(s)         ((s)->s_len < (s)->s_size - 1)
75 #define SBUF_FREESPACE(s)       ((s)->s_size - ((s)->s_len + 1))
76 #define SBUF_CANEXTEND(s)       ((s)->s_flags & SBUF_AUTOEXTEND)
77 #define SBUF_ISSECTION(s)       ((s)->s_flags & SBUF_INSECTION)
78 #define SBUF_NULINCLUDED(s)     ((s)->s_flags & SBUF_INCLUDENUL)
79 #define SBUF_ISDRAINTOEOR(s)    ((s)->s_flags & SBUF_DRAINTOEOR)
80 #define SBUF_DODRAINTOEOR(s)    (SBUF_ISSECTION(s) && SBUF_ISDRAINTOEOR(s))
81 #define SBUF_MALLOCFLAG(s)      \
82         (((s)->s_flags & SBUF_NOWAIT) ? M_NOWAIT : M_WAITOK)
83
84 /*
85  * Set / clear flags
86  */
87 #define SBUF_SETFLAG(s, f)      do { (s)->s_flags |= (f); } while (0)
88 #define SBUF_CLEARFLAG(s, f)    do { (s)->s_flags &= ~(f); } while (0)
89
90 #define SBUF_MINSIZE             2              /* Min is 1 byte + nulterm. */
91 #define SBUF_MINEXTENDSIZE      16              /* Should be power of 2. */
92
93 #ifdef PAGE_SIZE
94 #define SBUF_MAXEXTENDSIZE      PAGE_SIZE
95 #define SBUF_MAXEXTENDINCR      PAGE_SIZE
96 #else
97 #define SBUF_MAXEXTENDSIZE      4096
98 #define SBUF_MAXEXTENDINCR      4096
99 #endif
100
101 /*
102  * Debugging support
103  */
104 #if defined(_KERNEL) && defined(INVARIANTS)
105
106 static void
107 _assert_sbuf_integrity(const char *fun, struct sbuf *s)
108 {
109
110         KASSERT(s != NULL,
111             ("%s called with a NULL sbuf pointer", fun));
112         KASSERT(s->s_buf != NULL,
113             ("%s called with uninitialized or corrupt sbuf", fun));
114         if (SBUF_ISFINISHED(s) && SBUF_NULINCLUDED(s)) {
115                 KASSERT(s->s_len <= s->s_size,
116                     ("wrote past end of sbuf (%jd >= %jd)",
117                     (intmax_t)s->s_len, (intmax_t)s->s_size));
118         } else {
119                 KASSERT(s->s_len < s->s_size,
120                     ("wrote past end of sbuf (%jd >= %jd)",
121                     (intmax_t)s->s_len, (intmax_t)s->s_size));
122         }
123 }
124
125 static void
126 _assert_sbuf_state(const char *fun, struct sbuf *s, int state)
127 {
128
129         KASSERT((s->s_flags & SBUF_FINISHED) == state,
130             ("%s called with %sfinished or corrupt sbuf", fun,
131             (state ? "un" : "")));
132 }
133
134 #define assert_sbuf_integrity(s) _assert_sbuf_integrity(__func__, (s))
135 #define assert_sbuf_state(s, i)  _assert_sbuf_state(__func__, (s), (i))
136
137 #else /* _KERNEL && INVARIANTS */
138
139 #define assert_sbuf_integrity(s) do { } while (0)
140 #define assert_sbuf_state(s, i)  do { } while (0)
141
142 #endif /* _KERNEL && INVARIANTS */
143
144 #ifdef CTASSERT
145 CTASSERT(powerof2(SBUF_MAXEXTENDSIZE));
146 CTASSERT(powerof2(SBUF_MAXEXTENDINCR));
147 #endif
148
149 static int
150 sbuf_extendsize(int size)
151 {
152         int newsize;
153
154         if (size < (int)SBUF_MAXEXTENDSIZE) {
155                 newsize = SBUF_MINEXTENDSIZE;
156                 while (newsize < size)
157                         newsize *= 2;
158         } else {
159                 newsize = roundup2(size, SBUF_MAXEXTENDINCR);
160         }
161         KASSERT(newsize >= size, ("%s: %d < %d\n", __func__, newsize, size));
162         return (newsize);
163 }
164
165 /*
166  * Extend an sbuf.
167  */
168 static int
169 sbuf_extend(struct sbuf *s, int addlen)
170 {
171         char *newbuf;
172         int newsize;
173
174         if (!SBUF_CANEXTEND(s))
175                 return (-1);
176         newsize = sbuf_extendsize(s->s_size + addlen);
177         newbuf = SBMALLOC(newsize, SBUF_MALLOCFLAG(s));
178         if (newbuf == NULL)
179                 return (-1);
180         memcpy(newbuf, s->s_buf, s->s_size);
181         if (SBUF_ISDYNAMIC(s))
182                 SBFREE(s->s_buf);
183         else
184                 SBUF_SETFLAG(s, SBUF_DYNAMIC);
185         s->s_buf = newbuf;
186         s->s_size = newsize;
187         return (0);
188 }
189
190 /*
191  * Initialize an sbuf.
192  * If buf is non-NULL, it points to a static or already-allocated string
193  * big enough to hold at least length characters.
194  */
195 struct sbuf *
196 sbuf_new(struct sbuf *s, char *buf, int length, int flags)
197 {
198
199         KASSERT(length >= 0,
200             ("attempt to create an sbuf of negative length (%d)", length));
201         KASSERT((flags & ~SBUF_USRFLAGMSK) == 0,
202             ("%s called with invalid flags", __func__));
203         KASSERT((flags & SBUF_AUTOEXTEND) || length >= SBUF_MINSIZE,
204             ("sbuf buffer %d smaller than minimum %d bytes", length,
205             SBUF_MINSIZE));
206
207         flags &= SBUF_USRFLAGMSK;
208
209         /*
210          * Allocate 'DYNSTRUCT' sbuf from the heap, if NULL 's' was provided.
211          */
212         if (s == NULL) {
213                 s = SBMALLOC(sizeof(*s),
214                     (flags & SBUF_NOWAIT) ?  M_NOWAIT : M_WAITOK);
215                 if (s == NULL)
216                         goto out;
217                 SBUF_SETFLAG(s, SBUF_DYNSTRUCT);
218         } else {
219                 /*
220                  * DYNSTRUCT SBMALLOC sbufs are allocated with M_ZERO, but
221                  * user-provided sbuf objects must be initialized.
222                  */
223                 memset(s, 0, sizeof(*s));
224         }
225
226         s->s_flags |= flags;
227         s->s_size = length;
228         s->s_buf = buf;
229         /*
230          * Never-written sbufs do not need \n termination.
231          */
232         SBUF_SETFLAG(s, SBUF_DRAINATEOL);
233
234         /*
235          * Allocate DYNAMIC, i.e., heap data buffer backing the sbuf, if no
236          * buffer was provided.
237          */
238         if (s->s_buf == NULL) {
239                 if (SBUF_CANEXTEND(s))
240                         s->s_size = sbuf_extendsize(s->s_size);
241                 s->s_buf = SBMALLOC(s->s_size, SBUF_MALLOCFLAG(s));
242                 if (s->s_buf == NULL)
243                         goto out;
244                 SBUF_SETFLAG(s, SBUF_DYNAMIC);
245         }
246
247 out:
248         if (s != NULL && s->s_buf == NULL) {
249                 if (SBUF_ISDYNSTRUCT(s))
250                         SBFREE(s);
251                 s = NULL;
252         }
253         return (s);
254 }
255
256 #ifdef _KERNEL
257 /*
258  * Create an sbuf with uio data
259  */
260 struct sbuf *
261 sbuf_uionew(struct sbuf *s, struct uio *uio, int *error)
262 {
263
264         KASSERT(uio != NULL,
265             ("%s called with NULL uio pointer", __func__));
266         KASSERT(error != NULL,
267             ("%s called with NULL error pointer", __func__));
268
269         if (uio->uio_resid >= INT_MAX || uio->uio_resid < SBUF_MINSIZE - 1) {
270                 *error = EINVAL;
271                 return (NULL);
272         }
273         s = sbuf_new(s, NULL, uio->uio_resid + 1, 0);
274         if (s == NULL) {
275                 *error = ENOMEM;
276                 return (NULL);
277         }
278         *error = uiomove(s->s_buf, uio->uio_resid, uio);
279         if (*error != 0) {
280                 sbuf_delete(s);
281                 return (NULL);
282         }
283         s->s_len = s->s_size - 1;
284         if (SBUF_ISSECTION(s))
285                 s->s_sect_len = s->s_size - 1;
286         *error = 0;
287         return (s);
288 }
289 #endif
290
291 int
292 sbuf_get_flags(struct sbuf *s)
293 {
294
295         return (s->s_flags & SBUF_USRFLAGMSK);
296 }
297
298 void
299 sbuf_clear_flags(struct sbuf *s, int flags)
300 {
301
302         s->s_flags &= ~(flags & SBUF_USRFLAGMSK);
303 }
304
305 void
306 sbuf_set_flags(struct sbuf *s, int flags)
307 {
308
309         s->s_flags |= (flags & SBUF_USRFLAGMSK);
310 }
311
312 /*
313  * Clear an sbuf and reset its position.
314  */
315 void
316 sbuf_clear(struct sbuf *s)
317 {
318
319         assert_sbuf_integrity(s);
320         /* don't care if it's finished or not */
321         KASSERT(s->s_drain_func == NULL,
322             ("%s makes no sense on sbuf %p with drain", __func__, s));
323
324         SBUF_CLEARFLAG(s, SBUF_FINISHED);
325         s->s_error = 0;
326         s->s_len = 0;
327         s->s_rec_off = 0;
328         s->s_sect_len = 0;
329 }
330
331 /*
332  * Set the sbuf's end position to an arbitrary value.
333  * Effectively truncates the sbuf at the new position.
334  */
335 int
336 sbuf_setpos(struct sbuf *s, ssize_t pos)
337 {
338
339         assert_sbuf_integrity(s);
340         assert_sbuf_state(s, 0);
341
342         KASSERT(pos >= 0,
343             ("attempt to seek to a negative position (%jd)", (intmax_t)pos));
344         KASSERT(pos < s->s_size,
345             ("attempt to seek past end of sbuf (%jd >= %jd)",
346             (intmax_t)pos, (intmax_t)s->s_size));
347         KASSERT(!SBUF_ISSECTION(s),
348             ("attempt to seek when in a section"));
349
350         if (pos < 0 || pos > s->s_len)
351                 return (-1);
352         s->s_len = pos;
353         return (0);
354 }
355
356 /*
357  * Drain into a counter.  Counts amount of data without producing output.
358  * Useful for cases like sysctl, where user may first request only size.
359  * This allows to avoid pointless allocation/freeing of large buffers.
360  */
361 int
362 sbuf_count_drain(void *arg, const char *data __unused, int len)
363 {
364         size_t *sizep;
365
366         sizep = (size_t *)arg;
367         *sizep += len;
368         return (len);
369 }
370
371 /*
372  * Set up a drain function and argument on an sbuf to flush data to
373  * when the sbuf buffer overflows.
374  */
375 void
376 sbuf_set_drain(struct sbuf *s, sbuf_drain_func *func, void *ctx)
377 {
378
379         assert_sbuf_state(s, 0);
380         assert_sbuf_integrity(s);
381         KASSERT(func == s->s_drain_func || s->s_len == 0,
382             ("Cannot change drain to %p on non-empty sbuf %p", func, s));
383         s->s_drain_func = func;
384         s->s_drain_arg = ctx;
385 }
386
387 /*
388  * Call the drain and process the return.
389  */
390 int
391 sbuf_drain(struct sbuf *s)
392 {
393         int len;
394
395         /*
396          * Immediately return when no work to do,
397          * or an error has already been accumulated.
398          */
399         if ((s->s_len == 0) || (s->s_error != 0))
400                 return(s->s_error);
401
402         if (SBUF_DODRAINTOEOR(s) && s->s_rec_off == 0)
403                 return (s->s_error = EDEADLK);
404         len = s->s_drain_func(s->s_drain_arg, s->s_buf,
405             SBUF_DODRAINTOEOR(s) ? s->s_rec_off : s->s_len);
406         if (len <= 0) {
407                 s->s_error = len ? -len : EDEADLK;
408                 return (s->s_error);
409         }
410         KASSERT(len > 0 && len <= s->s_len,
411             ("Bad drain amount %d for sbuf %p", len, s));
412         s->s_len -= len;
413         s->s_rec_off -= len;
414         /*
415          * Fast path for the expected case where all the data was
416          * drained.
417          */
418         if (s->s_len == 0) {
419                 /*
420                  * When the s_buf is entirely drained, we need to remember if
421                  * the last character was a '\n' or not for
422                  * sbuf_nl_terminate().
423                  */
424                 if (s->s_buf[len - 1] == '\n')
425                         SBUF_SETFLAG(s, SBUF_DRAINATEOL);
426                 else
427                         SBUF_CLEARFLAG(s, SBUF_DRAINATEOL);
428                 return (0);
429         }
430         /*
431          * Move the remaining characters to the beginning of the
432          * string.
433          */
434         memmove(s->s_buf, s->s_buf + len, s->s_len);
435         return (0);
436 }
437
438 /*
439  * Append bytes to an sbuf.  This is the core function for appending
440  * to an sbuf and is the main place that deals with extending the
441  * buffer and marking overflow.
442  */
443 static void
444 sbuf_put_bytes(struct sbuf *s, const char *buf, size_t len)
445 {
446         size_t n;
447
448         assert_sbuf_integrity(s);
449         assert_sbuf_state(s, 0);
450
451         if (s->s_error != 0)
452                 return;
453         while (len > 0) {
454                 if (SBUF_FREESPACE(s) <= 0) {
455                         /*
456                          * If there is a drain, use it, otherwise extend the
457                          * buffer.
458                          */
459                         if (s->s_drain_func != NULL)
460                                 (void)sbuf_drain(s);
461                         else if (sbuf_extend(s, len > INT_MAX ? INT_MAX : len)
462                             < 0)
463                                 s->s_error = ENOMEM;
464                         if (s->s_error != 0)
465                                 return;
466                 }
467                 n = SBUF_FREESPACE(s);
468                 if (len < n)
469                         n = len;
470                 memcpy(&s->s_buf[s->s_len], buf, n);
471                 s->s_len += n;
472                 if (SBUF_ISSECTION(s))
473                         s->s_sect_len += n;
474                 len -= n;
475                 buf += n;
476         }
477 }
478
479 static void
480 sbuf_put_byte(struct sbuf *s, char c)
481 {
482
483         assert_sbuf_integrity(s);
484         assert_sbuf_state(s, 0);
485
486         if (__predict_false(s->s_error != 0))
487                 return;
488         if (__predict_false(SBUF_FREESPACE(s) <= 0)) {
489                 /*
490                  * If there is a drain, use it, otherwise extend the
491                  * buffer.
492                  */
493                 if (s->s_drain_func != NULL)
494                         (void)sbuf_drain(s);
495                 else if (sbuf_extend(s, 1) < 0)
496                         s->s_error = ENOMEM;
497                 if (s->s_error != 0)
498                         return;
499         }
500         s->s_buf[s->s_len++] = c;
501         if (SBUF_ISSECTION(s))
502                 s->s_sect_len++;
503 }
504
505 /*
506  * Append a byte string to an sbuf.
507  */
508 int
509 sbuf_bcat(struct sbuf *s, const void *buf, size_t len)
510 {
511
512         sbuf_put_bytes(s, buf, len);
513         if (s->s_error != 0)
514                 return (-1);
515         return (0);
516 }
517
518 #ifdef _KERNEL
519 /*
520  * Copy a byte string from userland into an sbuf.
521  */
522 int
523 sbuf_bcopyin(struct sbuf *s, const void *uaddr, size_t len)
524 {
525
526         assert_sbuf_integrity(s);
527         assert_sbuf_state(s, 0);
528         KASSERT(s->s_drain_func == NULL,
529             ("Nonsensical copyin to sbuf %p with a drain", s));
530
531         if (s->s_error != 0)
532                 return (-1);
533         if (len == 0)
534                 return (0);
535         if (len > SBUF_FREESPACE(s)) {
536                 sbuf_extend(s, len - SBUF_FREESPACE(s));
537                 if (SBUF_FREESPACE(s) < len)
538                         len = SBUF_FREESPACE(s);
539         }
540         if (copyin(uaddr, s->s_buf + s->s_len, len) != 0)
541                 return (-1);
542         s->s_len += len;
543
544         return (0);
545 }
546 #endif
547
548 /*
549  * Copy a byte string into an sbuf.
550  */
551 int
552 sbuf_bcpy(struct sbuf *s, const void *buf, size_t len)
553 {
554
555         assert_sbuf_integrity(s);
556         assert_sbuf_state(s, 0);
557
558         sbuf_clear(s);
559         return (sbuf_bcat(s, buf, len));
560 }
561
562 /*
563  * Append a string to an sbuf.
564  */
565 int
566 sbuf_cat(struct sbuf *s, const char *str)
567 {
568         size_t n;
569
570         n = strlen(str);
571         sbuf_put_bytes(s, str, n);
572         if (s->s_error != 0)
573                 return (-1);
574         return (0);
575 }
576
577 #ifdef _KERNEL
578 /*
579  * Append a string from userland to an sbuf.
580  */
581 int
582 sbuf_copyin(struct sbuf *s, const void *uaddr, size_t len)
583 {
584         size_t done;
585
586         assert_sbuf_integrity(s);
587         assert_sbuf_state(s, 0);
588         KASSERT(s->s_drain_func == NULL,
589             ("Nonsensical copyin to sbuf %p with a drain", s));
590
591         if (s->s_error != 0)
592                 return (-1);
593
594         if (len == 0)
595                 len = SBUF_FREESPACE(s);        /* XXX return 0? */
596         if (len > SBUF_FREESPACE(s)) {
597                 sbuf_extend(s, len);
598                 if (SBUF_FREESPACE(s) < len)
599                         len = SBUF_FREESPACE(s);
600         }
601         switch (copyinstr(uaddr, s->s_buf + s->s_len, len + 1, &done)) {
602         case ENAMETOOLONG:
603                 s->s_error = ENOMEM;
604                 /* fall through */
605         case 0:
606                 s->s_len += done - 1;
607                 if (SBUF_ISSECTION(s))
608                         s->s_sect_len += done - 1;
609                 break;
610         default:
611                 return (-1);    /* XXX */
612         }
613
614         return (done);
615 }
616 #endif
617
618 /*
619  * Copy a string into an sbuf.
620  */
621 int
622 sbuf_cpy(struct sbuf *s, const char *str)
623 {
624
625         assert_sbuf_integrity(s);
626         assert_sbuf_state(s, 0);
627
628         sbuf_clear(s);
629         return (sbuf_cat(s, str));
630 }
631
632 /*
633  * Format the given argument list and append the resulting string to an sbuf.
634  */
635 #ifdef _KERNEL
636
637 /*
638  * Append a non-NUL character to an sbuf.  This prototype signature is
639  * suitable for use with kvprintf(9).
640  */
641 static void
642 sbuf_putc_func(int c, void *arg)
643 {
644
645         if (__predict_true(c != '\0'))
646                 sbuf_put_byte(arg, c);
647 }
648
649 int
650 sbuf_vprintf(struct sbuf *s, const char *fmt, va_list ap)
651 {
652
653         assert_sbuf_integrity(s);
654         assert_sbuf_state(s, 0);
655
656         KASSERT(fmt != NULL,
657             ("%s called with a NULL format string", __func__));
658
659         (void)kvprintf(fmt, sbuf_putc_func, s, 10, ap);
660         if (s->s_error != 0)
661                 return (-1);
662         return (0);
663 }
664 #else /* !_KERNEL */
665 int
666 sbuf_vprintf(struct sbuf *s, const char *fmt, va_list ap)
667 {
668         va_list ap_copy;
669         int error, len;
670
671         assert_sbuf_integrity(s);
672         assert_sbuf_state(s, 0);
673
674         KASSERT(fmt != NULL,
675             ("%s called with a NULL format string", __func__));
676
677         if (s->s_error != 0)
678                 return (-1);
679
680         /*
681          * For the moment, there is no way to get vsnprintf(3) to hand
682          * back a character at a time, to push everything into
683          * sbuf_putc_func() as was done for the kernel.
684          *
685          * In userspace, while drains are useful, there's generally
686          * not a problem attempting to malloc(3) on out of space.  So
687          * expand a userland sbuf if there is not enough room for the
688          * data produced by sbuf_[v]printf(3).
689          */
690
691         error = 0;
692         do {
693                 va_copy(ap_copy, ap);
694                 len = vsnprintf(&s->s_buf[s->s_len], SBUF_FREESPACE(s) + 1,
695                     fmt, ap_copy);
696                 if (len < 0) {
697                         s->s_error = errno;
698                         return (-1);
699                 }
700                 va_end(ap_copy);
701
702                 if (SBUF_FREESPACE(s) >= len)
703                         break;
704                 /* Cannot print with the current available space. */
705                 if (s->s_drain_func != NULL && s->s_len > 0)
706                         error = sbuf_drain(s); /* sbuf_drain() sets s_error. */
707                 else if (sbuf_extend(s, len - SBUF_FREESPACE(s)) != 0)
708                         s->s_error = error = ENOMEM;
709         } while (error == 0);
710
711         /*
712          * s->s_len is the length of the string, without the terminating nul.
713          * When updating s->s_len, we must subtract 1 from the length that
714          * we passed into vsnprintf() because that length includes the
715          * terminating nul.
716          *
717          * vsnprintf() returns the amount that would have been copied,
718          * given sufficient space, so don't over-increment s_len.
719          */
720         if (SBUF_FREESPACE(s) < len)
721                 len = SBUF_FREESPACE(s);
722         s->s_len += len;
723         if (SBUF_ISSECTION(s))
724                 s->s_sect_len += len;
725
726         KASSERT(s->s_len < s->s_size,
727             ("wrote past end of sbuf (%d >= %d)", s->s_len, s->s_size));
728
729         if (s->s_error != 0)
730                 return (-1);
731         return (0);
732 }
733 #endif /* _KERNEL */
734
735 /*
736  * Format the given arguments and append the resulting string to an sbuf.
737  */
738 int
739 sbuf_printf(struct sbuf *s, const char *fmt, ...)
740 {
741         va_list ap;
742         int result;
743
744         va_start(ap, fmt);
745         result = sbuf_vprintf(s, fmt, ap);
746         va_end(ap);
747         return (result);
748 }
749
750 /*
751  * Append a character to an sbuf.
752  */
753 int
754 sbuf_putc(struct sbuf *s, int c)
755 {
756
757         sbuf_put_byte(s, c);
758         if (s->s_error != 0)
759                 return (-1);
760         return (0);
761 }
762
763 /*
764  * Append a trailing newline to a non-empty sbuf, if one is not already
765  * present.  Handles sbufs with drain functions correctly.
766  */
767 int
768 sbuf_nl_terminate(struct sbuf *s)
769 {
770
771         assert_sbuf_integrity(s);
772         assert_sbuf_state(s, 0);
773
774         /*
775          * If the s_buf isn't empty, the last byte is simply s_buf[s_len - 1].
776          *
777          * If the s_buf is empty because a drain function drained it, we
778          * remember if the last byte was a \n with the SBUF_DRAINATEOL flag in
779          * sbuf_drain().
780          *
781          * In either case, we only append a \n if the previous character was
782          * something else.
783          */
784         if (s->s_len == 0) {
785                 if (!SBUF_ISDRAINATEOL(s))
786                         sbuf_put_byte(s, '\n');
787         } else if (s->s_buf[s->s_len - 1] != '\n')
788                 sbuf_put_byte(s, '\n');
789
790         if (s->s_error != 0)
791                 return (-1);
792         return (0);
793 }
794
795 /*
796  * Trim whitespace characters from end of an sbuf.
797  */
798 int
799 sbuf_trim(struct sbuf *s)
800 {
801
802         assert_sbuf_integrity(s);
803         assert_sbuf_state(s, 0);
804         KASSERT(s->s_drain_func == NULL,
805             ("%s makes no sense on sbuf %p with drain", __func__, s));
806
807         if (s->s_error != 0)
808                 return (-1);
809
810         while (s->s_len > 0 && isspace(s->s_buf[s->s_len-1])) {
811                 --s->s_len;
812                 if (SBUF_ISSECTION(s))
813                         s->s_sect_len--;
814         }
815
816         return (0);
817 }
818
819 /*
820  * Check if an sbuf has an error.
821  */
822 int
823 sbuf_error(const struct sbuf *s)
824 {
825
826         return (s->s_error);
827 }
828
829 /*
830  * Finish off an sbuf.
831  */
832 int
833 sbuf_finish(struct sbuf *s)
834 {
835
836         assert_sbuf_integrity(s);
837         assert_sbuf_state(s, 0);
838
839         s->s_buf[s->s_len] = '\0';
840         if (SBUF_NULINCLUDED(s))
841                 s->s_len++;
842         if (s->s_drain_func != NULL) {
843                 while (s->s_len > 0 && s->s_error == 0)
844                         s->s_error = sbuf_drain(s);
845         }
846         SBUF_SETFLAG(s, SBUF_FINISHED);
847 #ifdef _KERNEL
848         return (s->s_error);
849 #else
850         if (s->s_error != 0) {
851                 errno = s->s_error;
852                 return (-1);
853         }
854         return (0);
855 #endif
856 }
857
858 /*
859  * Return a pointer to the sbuf data.
860  */
861 char *
862 sbuf_data(struct sbuf *s)
863 {
864
865         assert_sbuf_integrity(s);
866         assert_sbuf_state(s, SBUF_FINISHED);
867         KASSERT(s->s_drain_func == NULL,
868             ("%s makes no sense on sbuf %p with drain", __func__, s));
869
870         return (s->s_buf);
871 }
872
873 /*
874  * Return the length of the sbuf data.
875  */
876 ssize_t
877 sbuf_len(struct sbuf *s)
878 {
879
880         assert_sbuf_integrity(s);
881         /* don't care if it's finished or not */
882         KASSERT(s->s_drain_func == NULL,
883             ("%s makes no sense on sbuf %p with drain", __func__, s));
884
885         if (s->s_error != 0)
886                 return (-1);
887
888         /* If finished, nulterm is already in len, else add one. */
889         if (SBUF_NULINCLUDED(s) && !SBUF_ISFINISHED(s))
890                 return (s->s_len + 1);
891         return (s->s_len);
892 }
893
894 /*
895  * Clear an sbuf, free its buffer if necessary.
896  */
897 void
898 sbuf_delete(struct sbuf *s)
899 {
900         int isdyn;
901
902         assert_sbuf_integrity(s);
903         /* don't care if it's finished or not */
904
905         if (SBUF_ISDYNAMIC(s))
906                 SBFREE(s->s_buf);
907         isdyn = SBUF_ISDYNSTRUCT(s);
908         memset(s, 0, sizeof(*s));
909         if (isdyn)
910                 SBFREE(s);
911 }
912
913 /*
914  * Check if an sbuf has been finished.
915  */
916 int
917 sbuf_done(const struct sbuf *s)
918 {
919
920         return (SBUF_ISFINISHED(s));
921 }
922
923 /*
924  * Start a section.
925  */
926 void
927 sbuf_start_section(struct sbuf *s, ssize_t *old_lenp)
928 {
929
930         assert_sbuf_integrity(s);
931         assert_sbuf_state(s, 0);
932
933         if (!SBUF_ISSECTION(s)) {
934                 KASSERT(s->s_sect_len == 0,
935                     ("s_sect_len != 0 when starting a section"));
936                 if (old_lenp != NULL)
937                         *old_lenp = -1;
938                 s->s_rec_off = s->s_len;
939                 SBUF_SETFLAG(s, SBUF_INSECTION);
940         } else {
941                 KASSERT(old_lenp != NULL,
942                     ("s_sect_len should be saved when starting a subsection"));
943                 *old_lenp = s->s_sect_len;
944                 s->s_sect_len = 0;
945         }
946 }
947
948 /*
949  * End the section padding to the specified length with the specified
950  * character.
951  */
952 ssize_t
953 sbuf_end_section(struct sbuf *s, ssize_t old_len, size_t pad, int c)
954 {
955         ssize_t len;
956
957         assert_sbuf_integrity(s);
958         assert_sbuf_state(s, 0);
959         KASSERT(SBUF_ISSECTION(s),
960             ("attempt to end a section when not in a section"));
961
962         if (pad > 1) {
963                 len = roundup(s->s_sect_len, pad) - s->s_sect_len;
964                 for (; s->s_error == 0 && len > 0; len--)
965                         sbuf_put_byte(s, c);
966         }
967         len = s->s_sect_len;
968         if (old_len == -1) {
969                 s->s_rec_off = s->s_sect_len = 0;
970                 SBUF_CLEARFLAG(s, SBUF_INSECTION);
971         } else {
972                 s->s_sect_len += old_len;
973         }
974         if (s->s_error != 0)
975                 return (-1);
976         return (len);
977 }