strbuf.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158
  1. #include "debug.h"
  2. #include "util.h"
  3. #include <linux/kernel.h>
  4. #include <errno.h>
  5. /*
  6. * Used as the default ->buf value, so that people can always assume
  7. * buf is non NULL and ->buf is NUL terminated even for a freshly
  8. * initialized strbuf.
  9. */
  10. char strbuf_slopbuf[1];
  11. int strbuf_init(struct strbuf *sb, ssize_t hint)
  12. {
  13. sb->alloc = sb->len = 0;
  14. sb->buf = strbuf_slopbuf;
  15. if (hint)
  16. return strbuf_grow(sb, hint);
  17. return 0;
  18. }
  19. void strbuf_release(struct strbuf *sb)
  20. {
  21. if (sb->alloc) {
  22. zfree(&sb->buf);
  23. strbuf_init(sb, 0);
  24. }
  25. }
  26. char *strbuf_detach(struct strbuf *sb, size_t *sz)
  27. {
  28. char *res = sb->alloc ? sb->buf : NULL;
  29. if (sz)
  30. *sz = sb->len;
  31. strbuf_init(sb, 0);
  32. return res;
  33. }
  34. int strbuf_grow(struct strbuf *sb, size_t extra)
  35. {
  36. char *buf;
  37. size_t nr = sb->len + extra + 1;
  38. if (nr < sb->alloc)
  39. return 0;
  40. if (nr <= sb->len)
  41. return -E2BIG;
  42. if (alloc_nr(sb->alloc) > nr)
  43. nr = alloc_nr(sb->alloc);
  44. /*
  45. * Note that sb->buf == strbuf_slopbuf if sb->alloc == 0, and it is
  46. * a static variable. Thus we have to avoid passing it to realloc.
  47. */
  48. buf = realloc(sb->alloc ? sb->buf : NULL, nr * sizeof(*buf));
  49. if (!buf)
  50. return -ENOMEM;
  51. sb->buf = buf;
  52. sb->alloc = nr;
  53. return 0;
  54. }
  55. int strbuf_addch(struct strbuf *sb, int c)
  56. {
  57. int ret = strbuf_grow(sb, 1);
  58. if (ret)
  59. return ret;
  60. sb->buf[sb->len++] = c;
  61. sb->buf[sb->len] = '\0';
  62. return 0;
  63. }
  64. int strbuf_add(struct strbuf *sb, const void *data, size_t len)
  65. {
  66. int ret = strbuf_grow(sb, len);
  67. if (ret)
  68. return ret;
  69. memcpy(sb->buf + sb->len, data, len);
  70. return strbuf_setlen(sb, sb->len + len);
  71. }
  72. static int strbuf_addv(struct strbuf *sb, const char *fmt, va_list ap)
  73. {
  74. int len, ret;
  75. va_list ap_saved;
  76. if (!strbuf_avail(sb)) {
  77. ret = strbuf_grow(sb, 64);
  78. if (ret)
  79. return ret;
  80. }
  81. va_copy(ap_saved, ap);
  82. len = vsnprintf(sb->buf + sb->len, sb->alloc - sb->len, fmt, ap);
  83. if (len < 0)
  84. return len;
  85. if (len > strbuf_avail(sb)) {
  86. ret = strbuf_grow(sb, len);
  87. if (ret)
  88. return ret;
  89. len = vsnprintf(sb->buf + sb->len, sb->alloc - sb->len, fmt, ap_saved);
  90. va_end(ap_saved);
  91. if (len > strbuf_avail(sb)) {
  92. pr_debug("this should not happen, your vsnprintf is broken");
  93. return -EINVAL;
  94. }
  95. }
  96. return strbuf_setlen(sb, sb->len + len);
  97. }
  98. int strbuf_addf(struct strbuf *sb, const char *fmt, ...)
  99. {
  100. va_list ap;
  101. int ret;
  102. va_start(ap, fmt);
  103. ret = strbuf_addv(sb, fmt, ap);
  104. va_end(ap);
  105. return ret;
  106. }
  107. ssize_t strbuf_read(struct strbuf *sb, int fd, ssize_t hint)
  108. {
  109. size_t oldlen = sb->len;
  110. size_t oldalloc = sb->alloc;
  111. int ret;
  112. ret = strbuf_grow(sb, hint ? hint : 8192);
  113. if (ret)
  114. return ret;
  115. for (;;) {
  116. ssize_t cnt;
  117. cnt = read(fd, sb->buf + sb->len, sb->alloc - sb->len - 1);
  118. if (cnt < 0) {
  119. if (oldalloc == 0)
  120. strbuf_release(sb);
  121. else
  122. strbuf_setlen(sb, oldlen);
  123. return cnt;
  124. }
  125. if (!cnt)
  126. break;
  127. sb->len += cnt;
  128. ret = strbuf_grow(sb, 8192);
  129. if (ret)
  130. return ret;
  131. }
  132. sb->buf[sb->len] = '\0';
  133. return sb->len - oldlen;
  134. }