5 * (c) 2001 Straylight/Edgeware
8 /*----- Licensing notice --------------------------------------------------*
10 * This file is part of the mLib utilities library.
12 * mLib is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU Library General Public License as
14 * published by the Free Software Foundation; either version 2 of the
15 * License, or (at your option) any later version.
17 * mLib is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU Library General Public License for more details.
22 * You should have received a copy of the GNU Library General Public
23 * License along with mLib; if not, write to the Free
24 * Software Foundation, Inc., 59 Temple Place - Suite 330, Boston,
28 /*----- Header files ------------------------------------------------------*/
36 /*----- Main code ---------------------------------------------------------*/
38 /* --- @buf_init@ --- *
40 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
41 * @void *p@ = pointer to a buffer
42 * @size_t sz@ = size of the buffer
46 * Use: Initializes the buffer block appropriately.
49 void buf_init(buf *b, void *p, size_t sz)
56 /* --- @dbuf_create@ --- *
58 * Arguments: @dbuf *db@ = pointer to a dynamic buffer block
62 * Use: Initializes a dynamic buffer. The buffer is initially empty,
63 * and ready for writing.
66 void dbuf_create(dbuf *db) { DBCREATE(db); }
68 /* --- @dbuf_reset@ --- *
70 * Arguments: @dbuf *db@ = pointer to a buffer block
74 * Use: Resets a buffer so that it can be written again.
77 void dbuf_reset(dbuf *db) { DBRESET(db); }
79 /* --- @dbuf_destroy@ --- *
81 * Arguments: @dbuf *db@ = pointer to a buffer block
85 * Use: Release all of the resources held by a dynamic buffer.
88 void dbuf_destroy(dbuf *db) { DBDESTROY(db); }
90 /* --- @{,d}buf_break@ --- *
92 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
94 * Returns: Some negative value.
96 * Use: Marks a buffer as broken.
99 int buf_break(buf *b) { BBREAK(b); return (-1); }
100 int (dbuf_break)(dbuf *db) { DBBREAK(db); return (-1); }
102 /* --- @{,d}buf_flip@ --- *
104 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
108 * Use: Flips a buffer so that if you've just been writing to it,
109 * you can now read from the bit you've written.
112 void buf_flip(buf *b) { BFLIP(b); }
113 void (dbuf_flip)(dbuf *db) { DBFLIP(db); }
115 /* --- @{,d}buf_ensure@ --- *
117 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
118 * @size_t sz@ = size of data wanted
120 * Returns: Zero if it worked, nonzero if there wasn't enough space.
122 * Use: Ensures that there are @sz@ bytes still in the buffer.
125 int buf_ensure(buf *b, size_t sz) { return (BENSURE(b, sz)); }
126 int (dbuf_ensure)(dbuf *db, size_t sz) { return (dbuf_ensure(db, sz)); }
128 /* --- @{,d}buf_tryextend@ --- *
130 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
131 * @size_t sz@ = size of data wanted
133 * Returns: Zero if it worked, nonzero if the buffer won't grow.
135 * Use: Extend the buffer so that at least @sz@ bytes are available.
136 * This only works if the buffer is allocated.
139 int buf_tryextend(buf *b, size_t sz)
144 if (sz <= BLEFT(b)) return (0);
145 if (~b->f&(BF_ALLOC | BF_WRITE)) { b->f |= BF_BROKEN; return (-1); }
147 db = (dbuf *)b; len = DBLEN(db); want = sz + len;
149 GROWBUF_EXTEND(size_t, db->a, db->_b.base, db->sz, want, 64, 1);
150 db->_b.p = db->_b.base + len;
152 db->_b.limit = db->_b.base + db->sz;
155 int (dbuf_tryextend)(dbuf *db, size_t sz)
156 { return (dbuf_tryextend(db, sz)); }
158 /* --- @{,d}buf_get@ --- *
160 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
161 * @size_t sz@ = size of the buffer
163 * Returns: Pointer to the place in the buffer.
165 * Use: Reserves a space in the buffer of the requested size, and
166 * returns its start address.
169 void *buf_get(buf *b, size_t sz)
178 void *(dbuf_get)(dbuf *db, size_t sz)
179 { return (dbuf_get(db, sz)); }
181 /* --- @{,d}buf_put@ --- *
183 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
184 * @const void *p@ = pointer to a buffer
185 * @size_t sz@ = size of the buffer
187 * Returns: Zero if it worked, nonzero if there wasn't enough space.
189 * Use: Fetches data from some place and puts it in the buffer
192 int buf_put(buf *b, const void *p, size_t sz)
196 memcpy(BCUR(b), p, sz);
200 int (dbuf_put)(dbuf *db, const void *p, size_t sz)
201 { return (dbuf_put(db, p, sz)); }
203 /* --- @{,d}buf_fill@ --- *
205 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
206 * @int ch@ = fill character
207 * @size_t sz@ = size to fill
209 * Returns: Zero if it worked, nonzero if there wasn't enough space.
211 * Use: Write @sz@ bytes with value @ch@ to the buffer, as if with
215 int buf_fill(buf *b, int ch, size_t sz)
219 p = buf_get(b, sz); if (!p) return (-1);
220 if (sz) memset(p, ch, sz);
223 int (dbuf_fill)(dbuf *db, int ch, size_t sz)
224 { return (dbuf_fill(db, ch, sz)); }
226 /* --- @align_step@ --- *
228 * Arguments: @buf *b@ = pointer to a buffer block
229 * @size_t m, a@ = alignment parameters
231 * Returns: The number of bytes to skip or fill.
234 static size_t align_step(buf *b, size_t m, size_t a)
236 if (m < 2) return (0);
237 else if (!(m&(m - 1))) return ((a - BLEN(b))&(m - 1));
238 else return ((a + m - BLEN(b)%m)%m);
241 /* --- @{,d}buf_alignskip@ --- *
243 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
244 * @size_t m, a@ = alignment multiple and offset
246 * Returns: Zero if it worked, nonzero if there wasn't enough space.
248 * Use: Advance the buffer position as little as possible such that
249 * it is @a@ greater than a multiple of @m@. This doesn't write
250 * anything to the buffer, so it's probably not suitable for
251 * output: use @buf_alignfill@ instead.
254 int buf_alignskip(buf *b, size_t m, size_t a)
256 if (!buf_get(b, align_step(b, m, a))) return (-1);
259 int (dbuf_alignskip)(dbuf *db, size_t m, size_t a)
260 { return (dbuf_alignskip(db, m, a)); }
262 /* --- @{,d}buf_alignfill@ --- *
264 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
265 * @int ch@ = fill character
266 * @size_t m, a@ = alignment multiple and offset
268 * Returns: Zero if it worked, nonzero if there wasn't enough space.
270 * Use: Fill the buffer with as few copies of @ch@ as possible, as if
271 * by @memset@, to advance the buffer position to a value @a@
272 * greater than a multiple of @m@.
275 int buf_alignfill(buf *b, int ch, size_t m, size_t a)
276 { return (buf_fill(b, ch, align_step(b, m, a))); }
277 int (dbuf_alignfill)(dbuf *db, int ch, size_t m, size_t a)
278 { return (dbuf_alignfill(db, ch, m, a)); }
280 /* --- @{,d}buf_getbyte@ --- *
282 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
284 * Returns: A byte, or less than zero if there wasn't a byte there.
286 * Use: Gets a single byte from a buffer.
289 int buf_getbyte(buf *b)
295 int (dbuf_getbyte)(dbuf *db)
296 { return (dbuf_getbyte(db)); }
298 /* --- @{,d}buf_putbyte@ --- *
300 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
301 * @int ch@ = byte to write
303 * Returns: Zero if OK, nonzero if there wasn't enough space.
305 * Use: Puts a single byte in a buffer.
308 int buf_putbyte(buf *b, int ch)
315 int (dbuf_putbyte)(dbuf *db, int ch)
316 { return (dbuf_putbyte(db, ch)); }
318 /* --- @{,d}buf_getu{8,{16,24,32,64}{,l,b}}@ --- *
320 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
321 * @uintSZ *w@ = where to put the word
323 * Returns: Zero if OK, or nonzero if there wasn't a word there.
325 * Use: Gets a word of appropriate size and order from a buffer.
328 #define BUF_GETU_(n, W, w) \
329 int buf_getu##w(buf *b, uint##n *ww) \
331 if (BENSURE(b, SZ_##W)) return (-1); \
332 *ww = LOAD##W(b->p); \
336 int (dbuf_getu##w)(dbuf *db, uint##n *ww) \
337 { return (dbuf_getu##w(db, ww)); }
338 DOUINTCONV(BUF_GETU_)
340 /* --- @{,d}buf_getk64{,l,b}@ --- *
342 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
343 * @kludge64 *w@ = where to put the word
345 * Returns: Zero if OK, or nonzero if there wasn't a word there.
347 * Use: Gets a word of appropriate size and order from a buffer.
350 int buf_getk64(buf *b, kludge64 *w)
352 if (BENSURE(b, 8)) return (-1);
353 LOAD64_(*w, b->p); BSTEP(b, 8); return (0);
356 int buf_getk64l(buf *b, kludge64 *w)
358 if (BENSURE(b, 8)) return (-1);
359 LOAD64_L_(*w, b->p); BSTEP(b, 8); return (0);
362 int buf_getk64b(buf *b, kludge64 *w)
364 if (BENSURE(b, 8)) return (-1);
365 LOAD64_B_(*w, b->p); BSTEP(b, 8); return (0);
368 int (dbuf_getk64)(dbuf *db, kludge64 *w) { return (dbuf_getk64(db, w)); }
369 int (dbuf_getk64l)(dbuf *db, kludge64 *w) { return (dbuf_getk64l(db, w)); }
370 int (dbuf_getk64b)(dbuf *db, kludge64 *w) { return (dbuf_getk64b(db, w)); }
372 /* --- @{,d}buf_putu{8,{16,24,32,64}{,l,b}}@ --- *
374 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
375 * @uintSZ w@ = word to write
377 * Returns: Zero if OK, or nonzero if there wasn't enough space
379 * Use: Puts a word into a buffer with appropriate size and order.
382 #define BUF_PUTU_(n, W, w) \
383 int buf_putu##w(buf *b, uint##n ww) \
385 if (BENSURE(b, SZ_##W)) return (-1); \
386 STORE##W(b->p, ww); \
390 int (dbuf_putu##w)(dbuf *db, uint##n ww) \
391 { return (dbuf_putu##w(db, ww)); }
392 DOUINTCONV(BUF_PUTU_)
394 /* --- @{,d}buf_putk64{,l,b}@ --- *
396 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
397 * @kludge64 w@ = word to write
399 * Returns: Zero if OK, or nonzero if there wasn't enough space
401 * Use: Gets a word of appropriate size and order from a buffer.
404 int buf_putk64(buf *b, kludge64 w)
406 if (BENSURE(b, 8)) return (-1);
407 STORE64_(b->p, w); BSTEP(b, 8); return (0);
410 int buf_putk64l(buf *b, kludge64 w)
412 if (BENSURE(b, 8)) return (-1);
413 STORE64_L_(b->p, w); BSTEP(b, 8); return (0);
416 int buf_putk64b(buf *b, kludge64 w)
418 if (BENSURE(b, 8)) return (-1);
419 STORE64_B_(b->p, w); BSTEP(b, 8); return (0);
422 int (dbuf_putk64)(dbuf *db, kludge64 w) { return (dbuf_putk64(db, w)); }
423 int (dbuf_putk64l)(dbuf *db, kludge64 w) { return (dbuf_putk64l(db, w)); }
424 int (dbuf_putk64b)(dbuf *db, kludge64 w) { return (dbuf_putk64b(db, w)); }
428 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
429 * @size_t *nn@ = where to put the length
431 * Returns: Zero if OK, nonzero if there wasn't a null byte to be found.
433 * Use: Finds a terminating null byte. The length includes this
437 static int findz(buf *b, size_t *nn)
441 if ((p = memchr(BCUR(b), 0, BLEFT(b))) == 0) { BBREAK(b); return (-1); }
442 *nn = p - BCUR(b) + 1;
446 /* --- @{,d}buf_getmem{8,{16,24,32,64}{,l,b},z} --- *
448 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
449 * @size_t *nn@ = where to put the length
451 * Returns: Pointer to the buffer data, or null.
453 * Use: Gets a chunk of memory from a buffer. The suffix is the
454 * width and byte order of the length; @z@ means null-
458 #define BUF_GETMEM_(n, W, w) \
459 void *buf_getmem##w(buf *b, size_t *nn) \
462 if (buf_getu##w(b, &sz)) return (0); \
463 if (BENSURE(b, sz)) return (0); \
465 return (buf_get(b, sz)); \
467 void *(dbuf_getmem##w)(dbuf *db, size_t *nn) \
468 { return (dbuf_getmem##w(db, nn)); }
469 DOUINTCONV(BUF_GETMEM_)
471 void *buf_getmemz(buf *b, size_t *nn)
473 if (findz(b, nn)) return (0);
474 return (buf_get(b, *nn));
476 void *(dbuf_getmemz)(dbuf *db, size_t *nn)
477 { return (dbuf_getmemz(db, nn)); }
481 static void *getmem_k64(buf *b, size_t *nn_out, kludge64 k)
486 ASSIGN64(szmax, (size_t)-1);
487 if (CMP64(k, >, szmax)) { BBREAK(b); return (-1); }
488 n = GET64(size_t, k); *nn_out = n; return (buf_get(b, n));
491 void *buf_getmem64(buf *b, size_t *nn)
495 if (buf_getk64(b, &k)) return (-1);
496 return (getmem_k64(b, nn, k));
499 void *buf_getmem64l(buf *b, size_t *nn)
503 if (buf_getk64l(b, &k)) return (-1);
504 return (getmem_k64(b, nn, k));
507 void *buf_getmem64b(buf *b, size_t *nn)
511 if (buf_getk64b(b, &k)) return (-1);
512 return (getmem_k64(b, nn, k));
515 void *(dbuf_getmem64)(dbuf *db, size_t *nn)
516 { return (dbuf_getmem64(db, nn)); }
517 void *(dbuf_getmem64l)(dbuf *db, size_t *nn)
518 { return (dbuf_getmem64l(db, nn)); }
519 void *(dbuf_getmem64b)(dbuf *db, size_t *nn)
520 { return (dbuf_getmem64b(db, nn)); }
524 /* --- @{,d}buf_putmem{8,{16,24,32,64}{,l,b},z} --- *
526 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
527 * @const void *p@ = pointer to data to write
528 * @size_t n@ = length to write
530 * Returns: Zero if OK, nonzero if there wasn't enough space.
532 * Use: Writes a chunk of data to a buffer. The suffix is the
533 * width and byte order of the length; @z@ means null-
537 #define BUF_PUTMEM_(n, W, w) \
538 int buf_putmem##w(buf *b, const void *p, size_t sz) \
540 MUFFLE_WARNINGS_STMT \
541 (CLANG_WARNING("-Wtautological-constant-out-of-range-compare"), \
542 { if (sz > MASK##W) { BBREAK(b); return (-1); } }); \
543 if (buf_putu##w(b, sz) || buf_put(b, p, sz)) \
547 int (dbuf_putmem##w)(dbuf *db, const void *p, size_t sz) \
548 { return (dbuf_putmem##w(db, p, sz)); }
549 DOUINTCONV(BUF_PUTMEM_)
553 void *buf_putmem64(buf *b, const void *p, size_t n)
557 ASSIGN64(k, n); if (buf_putk64(b, k) || buf_put(b, p, n)) return (-1);
561 void *buf_putmem64l(buf *b, const void *p, size_t n)
565 ASSIGN64(k, n); if (buf_putk64l(b, k) || buf_put(b, p, n)) return (-1);
569 void *buf_putmem64b(buf *b, const void *p, size_t n)
573 ASSIGN64(k, n); if (buf_putk64b(b, k) || buf_put(b, p, n)) return (-1);
577 int (dbuf_putmem64)(dbuf *db, const void *p, size_t n)
578 { return (dbuf_putmem64(db, p, n)); }
579 int (dbuf_putmem64l)(dbuf *db, const void *p, size_t n)
580 { return (dbuf_putmem64l(db, p, n)); }
581 int (dbuf_putmem64b)(dbuf *db, const void *p, size_t n)
582 { return (dbuf_putmem64b(db, p, n)); }
586 int buf_putmemz(buf *b, const void *p, size_t n)
590 if (memchr(p, 0, n)) { BBREAK(b); return (-1); }
591 if ((q = buf_get(b, n + 1)) == 0)
597 int (dbuf_putmemz)(dbuf *db, const void *p, size_t n)
598 { return (dbuf_putmemz(db, p, n)); }
600 /* --- @{,d}buf_getbuf{8,{16,24,32,64}{,l,b},z} --- *
602 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
603 * @buf *bb@ = where to put the result
605 * Returns: Zero if it worked, nonzero if there wasn't enough space.
607 * Use: Gets a block of data from a buffer, and writes its bounds to
611 #define BUF_GETBUF_(n, W, w) \
612 int buf_getbuf##w(buf *b, buf *bb) \
617 if ((p = buf_getmem##w(b, &sz)) == 0) \
619 buf_init(bb, p, sz); \
622 int (dbuf_getbuf##w)(dbuf *db, buf *bb) \
623 { return (dbuf_getbuf##w(db, bb)); }
624 BUF_DOSUFFIXES(BUF_GETBUF_)
626 /* --- @{,d}buf_putbuf{8,{16,24,32,64}{,l,b},z} --- *
628 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
629 * @buf *bb@ = buffer to write
631 * Returns: Zero if it worked, nonzero if there wasn't enough space.
633 * Use: Puts the contents of a buffer to a buffer.
636 #define BUF_PUTBUF_(n, W, w) \
637 int buf_putbuf##w(buf *b, buf *bb) \
638 { return (buf_putmem##w(b, BBASE(bb), BLEN(bb))); } \
639 int (dbuf_putbuf##w)(dbuf *db, buf *bb) \
640 { return (dbuf_putbuf##w(db, bb)); }
641 BUF_DOSUFFIXES(BUF_PUTBUF_)
643 /* --- @{,d}buf_putstr{8,{16,24,32,64}{,l,b},z} --- *
645 * Arguments: @buf *b@ or @dbuf *db@ = pointer to a buffer block
646 * @const char *p@ = string to write
648 * Returns: Zero if it worked, nonzero if there wasn't enough space.
650 * Use: Puts a null-terminated string to a buffer.
653 #define BUF_PUTSTR_(n, W, w) \
654 int buf_putstr##w(buf *b, const char *p) \
655 { return (buf_putmem##w(b, p, strlen(p))); } \
656 int (dbuf_putstr##w)(dbuf *db, const char *p) \
657 { return (dbuf_putstr##w(db, p)); }
658 BUF_DOSUFFIXES(BUF_PUTSTR_)
660 /*----- That's all, folks -------------------------------------------------*/