src/console/vsprintf.c

   1 /*
   2  * This file is part of the coreboot project.
   3  *
   4  * Copyright (C) 2009 coresystems GmbH
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License as
   8  * published by the Free Software Foundation; version 2 of
   9  * the License.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  */
  16
  17 #include <console/vtxprintf.h>
  18 #include <string.h>
  19 #include <trace.h>
  20
  21 struct vsnprintf_context {
  22         char *str_buf;
  23         size_t buf_limit;
  24 };
  25
  26 static void str_tx_byte(unsigned char byte, void *data)
  27 {
  28         struct vsnprintf_context *ctx = data;
  29         if (ctx->buf_limit) {
  30                 *ctx->str_buf = byte;
  31                 ctx->str_buf++;
  32                 ctx->buf_limit--;
  33         }
  34 }
  35
  36 int vsnprintf(char *buf, size_t size, const char *fmt, va_list args)
  37 {
  38         int i;
  39         struct vsnprintf_context ctx;
  40
  41         DISABLE_TRACE;
  42
  43         ctx.str_buf = buf;
  44         ctx.buf_limit = size ? size - 1 : 0;
  45         i = vtxprintf(str_tx_byte, fmt, args, &ctx);
  46         if (size)
  47                 *ctx.str_buf = '\0';
  48
  49         ENABLE_TRACE;
  50
  51         return i;
  52 }
  53
  54 int snprintf(char *buf, size_t size, const char *fmt, ...)
  55 {
  56         va_list args;
  57         int i;
  58
  59         va_start(args, fmt);
  60         i = vsnprintf(buf, size, fmt, args);
  61         va_end(args);
  62
  63         return i;
  64 }