/*- * Copyright 2016 Vsevolod Stakhov * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ /* Copyright (C) 2002-2015 Igor Sysoev * Copyright (C) 2011-2015 Nginx, Inc. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED ''AS IS'' AND ANY * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL AUTHOR BE LIABLE FOR ANY * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include "printf.h" #include "fstring.h" #include "str_util.h" #include /** * From FreeBSD libutil code */ static const int maxscale = 6; static const gchar _hex[] = "0123456789abcdef"; static const gchar _HEX[] = "0123456789ABCDEF"; static gchar * rspamd_humanize_number (gchar *buf, gchar *last, gint64 num, gboolean bytes) { const gchar *prefixes; int i, r, remainder, sign; gint64 divisor; gsize len = last - buf; remainder = 0; if (!bytes) { divisor = 1000; prefixes = "\0\0\0k\0\0M\0\0G\0\0T\0\0P\0\0E"; } else { divisor = 1024; prefixes = "B\0\0k\0\0M\0\0G\0\0T\0\0P\0\0E"; } #define SCALE2PREFIX(scale) (&prefixes[(scale) * 3]) if (num < 0) { sign = -1; num = -num; } else { sign = 1; } /* * Divide the number until it fits the given column. * If there will be an overflow by the rounding below, * divide once more. */ for (i = 0; i < maxscale && num > divisor; i++) { remainder = num % divisor; num /= divisor; } if (remainder == 0 || num > divisor / 2) { r = rspamd_snprintf (buf, len, "%L%s", sign * (num + (remainder + 50) / divisor), SCALE2PREFIX (i)); } else { /* Floating point version */ r = rspamd_snprintf (buf, len, "%.2f%s", sign * (num + remainder / (gdouble)divisor), SCALE2PREFIX (i)); } #undef SCALE2PREFIX return buf + r; } static gchar * rspamd_sprintf_num (gchar *buf, gchar *last, guint64 ui64, gchar zero, guint hexadecimal, guint width) { gchar *p, temp[sizeof ("18446744073709551615")]; size_t len; guint32 ui32; p = temp + sizeof(temp); if (hexadecimal == 0) { if (ui64 <= G_MAXUINT32) { /* * To divide 64-bit numbers and to find remainders * on the x86 platform gcc and icc call the libc functions * [u]divdi3() and [u]moddi3(), they call another function * in its turn. On FreeBSD it is the qdivrem() function, * its source code is about 170 lines of the code. * The glibc counterpart is about 150 lines of the code. * * For 32-bit numbers and some divisors gcc and icc use * a inlined multiplication and shifts. For example, * guint "i32 / 10" is compiled to * * (i32 * 0xCCCCCCCD) >> 35 */ ui32 = (guint32) ui64; do { *--p = (gchar) (ui32 % 10 + '0'); } while (ui32 /= 10); } else { do { *--p = (gchar) (ui64 % 10 + '0'); } while (ui64 /= 10); } } else if (hexadecimal == 1) { do { /* the "(guint32)" cast disables the BCC's warning */ *--p = _hex[(guint32) (ui64 & 0xf)]; } while (ui64 >>= 4); } else { /* hexadecimal == 2 */ do { /* the "(guint32)" cast disables the BCC's warning */ *--p = _HEX[(guint32) (ui64 & 0xf)]; } while (ui64 >>= 4); } /* zero or space padding */ len = (temp + sizeof (temp)) - p; while (len++ < width && buf < last) { *buf++ = zero; } /* number safe copy */ len = (temp + sizeof (temp)) - p; if (buf + len > last) { len = last - buf; } return ((gchar *)memcpy (buf, p, len)) + len; } struct rspamd_printf_char_buf { char *begin; char *pos; glong remain; }; static glong rspamd_printf_append_char (const gchar *buf, glong buflen, gpointer ud) { struct rspamd_printf_char_buf *dst = (struct rspamd_printf_char_buf *)ud; glong wr; if (dst->remain <= 0) { return dst->remain; } wr = MIN (dst->remain, buflen); memcpy (dst->pos, buf, wr); dst->remain -= wr; dst->pos += wr; return wr; } static glong rspamd_printf_append_file (const gchar *buf, glong buflen, gpointer ud) { FILE *dst = (FILE *)ud; if (buflen > 0) { return fwrite (buf, 1, buflen, dst); } else { return 0; } } static glong rspamd_printf_append_gstring (const gchar *buf, glong buflen, gpointer ud) { GString *dst = (GString *)ud; if (buflen > 0) { g_string_append_len (dst, buf, buflen); } return buflen; } static glong rspamd_printf_append_fstring (const gchar *buf, glong buflen, gpointer ud) { rspamd_fstring_t **dst = ud; if (buflen > 0) { *dst = rspamd_fstring_append (*dst, buf, buflen); } return buflen; } glong rspamd_fprintf (FILE *f, const gchar *fmt, ...) { va_list args; glong r; va_start (args, fmt); r = rspamd_vprintf_common (rspamd_printf_append_file, f, fmt, args); va_end (args); return r; } glong rspamd_printf (const gchar *fmt, ...) { va_list args; glong r; va_start (args, fmt); r = rspamd_vprintf_common (rspamd_printf_append_file, stdout, fmt, args); va_end (args); return r; } glong rspamd_log_fprintf (FILE *f, const gchar *fmt, ...) { va_list args; glong r; va_start (args, fmt); r = rspamd_vprintf_common (rspamd_printf_append_file, f, fmt, args); va_end (args); fflush (f); return r; } glong rspamd_snprintf (gchar *buf, glong max, const gchar *fmt, ...) { gchar *r; va_list args; va_start (args, fmt); r = rspamd_vsnprintf (buf, max, fmt, args); va_end (args); return (r - buf); } gchar * rspamd_vsnprintf (gchar *buf, glong max, const gchar *fmt, va_list args) { struct rspamd_printf_char_buf dst; dst.begin = buf; dst.pos = dst.begin; dst.remain = max - 1; (void)rspamd_vprintf_common (rspamd_printf_append_char, &dst, fmt, args); *dst.pos = '\0'; return dst.pos; } glong rspamd_printf_gstring (GString *s, const gchar *fmt, ...) { va_list args; glong r; va_start (args, fmt); r = rspamd_vprintf_gstring (s, fmt, args); va_end (args); return r; } glong rspamd_vprintf_gstring (GString *s, const gchar *fmt, va_list args) { return rspamd_vprintf_common (rspamd_printf_append_gstring, s, fmt, args); } glong rspamd_printf_fstring (rspamd_fstring_t **s, const gchar *fmt, ...) { va_list args; glong r; va_start (args, fmt); r = rspamd_vprintf_fstring (s, fmt, args); va_end (args); return r; } glong rspamd_vprintf_fstring (rspamd_fstring_t **s, const gchar *fmt, va_list args) { return rspamd_vprintf_common (rspamd_printf_append_fstring, s, fmt, args); } #define RSPAMD_PRINTF_APPEND(buf, len) \ do { \ RSPAMD_PRINTF_APPEND_BUF(buf, len); \ fmt++; \ buf_start = fmt; \ } while (0) #define RSPAMD_PRINTF_APPEND_BUF(buf, len) \ do { \ wr = func ((buf), (len), apd); \ if (wr < (__typeof (wr))(len)) { \ goto oob; \ } \ written += wr; \ } while (0) glong rspamd_vprintf_common (rspamd_printf_append_func func, gpointer apd, const gchar *fmt, va_list args) { gchar zero, numbuf[G_ASCII_DTOSTR_BUF_SIZE], *p, *last, c; const gchar *buf_start = fmt; gint d; gdouble f, scale; glong written = 0, wr, slen; gint64 i64; guint64 ui64; guint width, sign, hex, humanize, bytes, frac_width, i, b32; rspamd_fstring_t *v; rspamd_ftok_t *tok; GString *gs; GError *err; gboolean bv; while (*fmt) { /* * "buf < last" means that we could copy at least one character: * the plain character, "%%", "%c", and minus without the checking */ if (*fmt == '%') { /* Append what we have in buf */ if (fmt > buf_start) { wr = func (buf_start, fmt - buf_start, apd); if (wr <= 0) { goto oob; } written += wr; } i64 = 0; ui64 = 0; zero = (gchar) ((*++fmt == '0') ? '0' : ' '); width = 0; sign = 1; hex = 0; b32 = 0; bytes = 0; humanize = 0; frac_width = 0; slen = -1; while (*fmt >= '0' && *fmt <= '9') { width = width * 10 + *fmt++ - '0'; } for (;; ) { switch (*fmt) { case 'u': sign = 0; fmt++; continue; case 'm': fmt++; continue; case 'X': hex = 2; sign = 0; fmt++; continue; case 'x': hex = 1; sign = 0; fmt++; continue; case 'b': b32 = 1; sign = 0; fmt++; continue; case 'H': humanize = 1; bytes = 1; sign = 0; fmt++; continue; case 'h': humanize = 1; sign = 0; fmt++; continue; case '.': fmt++; if (*fmt == '*') { d = (gint)va_arg (args, gint); if (G_UNLIKELY (d < 0)) { return 0; } frac_width = (guint)d; fmt++; } else { while (*fmt >= '0' && *fmt <= '9') { frac_width = frac_width * 10 + *fmt++ - '0'; } } break; case '*': d = (gint)va_arg (args, gint); if (G_UNLIKELY (d < 0)) { return 0; } slen = (glong)d; fmt++; continue; default: break; } break; } switch (*fmt) { case 'V': v = va_arg (args, rspamd_fstring_t *); if (v) { slen = v->len; if (G_UNLIKELY (width != 0)) { slen = MIN (v->len, width); } RSPAMD_PRINTF_APPEND (v->str, slen); } else { RSPAMD_PRINTF_APPEND ("(NULL)", 6); } continue; case 'T': tok = va_arg (args, rspamd_ftok_t *); if (tok) { slen = tok->len; if (G_UNLIKELY (width != 0)) { slen = MIN (tok->len, width); } RSPAMD_PRINTF_APPEND (tok->begin, slen); } else { RSPAMD_PRINTF_APPEND ("(NULL)", 6); } continue; case 'v': gs = va_arg (args, GString *); if (gs) { slen = gs->len; if (G_UNLIKELY (width != 0)) { slen = MIN (gs->len, width); } RSPAMD_PRINTF_APPEND (gs->str, slen); } else { RSPAMD_PRINTF_APPEND ("(NULL)", 6); } continue; case 'e': err = va_arg (args, GError *); if (err) { p = err->message; if (p == NULL) { p = "(NULL)"; } } else { p = "unknown error"; } slen = strlen (p); RSPAMD_PRINTF_APPEND (p, slen); continue; case 's': p = va_arg (args, gchar *); if (p == NULL) { p = "(NULL)"; } if (G_UNLIKELY (b32)) { gchar *b32buf; if (G_UNLIKELY (slen == -1)) { if (G_LIKELY (width != 0)) { slen = width; } else { /* NULL terminated string */ slen = strlen (p); } } b32buf = rspamd_encode_base32 (p, slen); if (b32buf) { RSPAMD_PRINTF_APPEND (b32buf, strlen (b32buf)); g_free (b32buf); } else { RSPAMD_PRINTF_APPEND ("(NULL)", sizeof ("(NULL)") - 1); } } else if (G_UNLIKELY (hex)) { gchar hexbuf[2]; if (G_UNLIKELY (slen == -1)) { if (G_LIKELY (width != 0)) { slen = width; } else { /* NULL terminated string */ slen = strlen (p); } } while (slen) { hexbuf[0] = hex == 2 ? _HEX[(*p >> 4) & 0xf] : _hex[(*p >> 4) & 0xf]; hexbuf[1] = hex == 2 ? _HEX[*p & 0xf] : _hex[*p & 0xf]; RSPAMD_PRINTF_APPEND_BUF (hexbuf, 2); p++; slen--; } fmt++; buf_start = fmt; } else { if (slen == -1) { /* NULL terminated string */ slen = strlen (p); } if (G_UNLIKELY (width != 0)) { slen = MIN (slen, width); } RSPAMD_PRINTF_APPEND (p, slen); } continue; case 'O': i64 = (gint64) va_arg (args, off_t); sign = 1; break; case 'P': i64 = (gint64) va_arg (args, pid_t); sign = 1; break; case 't': i64 = (gint64) va_arg (args, time_t); sign = 1; break; case 'z': if (sign) { i64 = (gint64) va_arg (args, ssize_t); } else { ui64 = (guint64) va_arg (args, size_t); } break; case 'd': if (sign) { i64 = (gint64) va_arg (args, gint); } else { ui64 = (guint64) va_arg (args, guint); } break; case 'l': if (sign) { i64 = (gint64) va_arg (args, glong); } else { ui64 = (guint64) va_arg (args, gulong); } break; case 'D': if (sign) { i64 = (gint64) va_arg (args, gint32); } else { ui64 = (guint64) va_arg (args, guint32); } break; case 'L': if (sign) { i64 = va_arg (args, gint64); } else { ui64 = va_arg (args, guint64); } break; case 'f': case 'F': if (*fmt == 'f') { f = (gdouble) va_arg (args, double); } else { f = (gdouble) va_arg (args, long double); } if (isfinite (f)) { p = numbuf; last = p + sizeof (numbuf); if (f < 0) { *p++ = '-'; f = -f; } if (frac_width == 0) { frac_width = 6; } ui64 = (gint64) f; p = rspamd_sprintf_num (p, last, ui64, zero, 0, width); if (frac_width) { if (p < last) { *p++ = '.'; } scale = 1.0; for (i = 0; i < frac_width; i++) { scale *= 10.0; } /* * (gint64) cast is required for msvc6: * it can not convert guint64 to double */ ui64 = (guint64) ((f - (gint64) ui64) * scale); p = rspamd_sprintf_num (p, last, ui64, '0', 0, frac_width); } slen = p - numbuf; RSPAMD_PRINTF_APPEND (numbuf, slen); } else if (isnan (f)) { RSPAMD_PRINTF_APPEND ("NaN", 3); } else { if (signbit (f)) { RSPAMD_PRINTF_APPEND ("-Inf", 4); } else { RSPAMD_PRINTF_APPEND ("+Inf", 4); } } continue; case 'g': case 'G': if (*fmt == 'g') { f = (gdouble) va_arg (args, double); } else { f = (gdouble) va_arg (args, long double); } g_ascii_formatd (numbuf, sizeof (numbuf), "%g", (double)f); slen = strlen (numbuf); RSPAMD_PRINTF_APPEND (numbuf, slen); continue; case 'B': bv = (gboolean) va_arg (args, double); RSPAMD_PRINTF_APPEND (bv ? "true" : "false", bv ? 4 : 5); continue; case 'p': ui64 = (uintptr_t) va_arg (args, void *); hex = 2; sign = 0; zero = '0'; width = sizeof (void *) * 2; break; case 'c': c = va_arg (args, gint); c &= 0xff; RSPAMD_PRINTF_APPEND (&c, 1); continue; case 'Z': c = '\0'; RSPAMD_PRINTF_APPEND (&c, 1); continue; case 'N': c = '\n'; RSPAMD_PRINTF_APPEND (&c, 1); continue; case '%': c = '%'; RSPAMD_PRINTF_APPEND (&c, 1); continue; default: c = *fmt; RSPAMD_PRINTF_APPEND (&c, 1); continue; } /* Print number */ p = numbuf; last = p + sizeof (numbuf); if (sign) { if (i64 < 0) { *p++ = '-'; ui64 = (guint64) - i64; } else { ui64 = (guint64) i64; } } if (!humanize) { p = rspamd_sprintf_num (p, last, ui64, zero, hex, width); } else { p = rspamd_humanize_number (p, last, ui64, bytes); } slen = p - numbuf; RSPAMD_PRINTF_APPEND (numbuf, slen); } else { fmt++; } } /* Finish buffer */ if (fmt > buf_start) { wr = func (buf_start, fmt - buf_start, apd); if (wr <= 0) { goto oob; } written += wr; } oob: return written; }