blob: 1fb834f3827629d385b151e706765890791612d1 [file] [log] [blame]
Eric Biederman8ca8d762003-04-22 19:02:15 +00001/*
Stefan Reinauer52fc6b12009-10-24 13:06:04 +00002 * This file is part of the coreboot project.
Stefan Reinauer14e22772010-04-27 06:56:47 +00003 *
Stefan Reinauer52fc6b12009-10-24 13:06:04 +00004 * Copyright (C) 2009 coresystems GmbH
Eric Biederman8ca8d762003-04-22 19:02:15 +00005 *
Stefan Reinauer52fc6b12009-10-24 13:06:04 +00006 * 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 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
19 * MA 02110-1301 USA
Eric Biederman8ca8d762003-04-22 19:02:15 +000020 */
21
Myles Watson58170782009-10-28 16:13:28 +000022#include <string.h>
Stefan Reinauer52fc6b12009-10-24 13:06:04 +000023#include <console/vtxprintf.h>
Rudolf Marek7f0e9302011-09-02 23:23:41 +020024#include <trace.h>
Eric Biederman8ca8d762003-04-22 19:02:15 +000025
Vladimir Serbinenko4b5012a2013-11-26 22:07:47 +010026struct vsnprintf_context
Eric Biederman8ca8d762003-04-22 19:02:15 +000027{
Vladimir Serbinenko22676582013-11-26 21:48:57 +010028 char *str_buf;
Vladimir Serbinenko4b5012a2013-11-26 22:07:47 +010029 size_t buf_limit;
Vladimir Serbinenko22676582013-11-26 21:48:57 +010030};
31
32static void str_tx_byte(unsigned char byte, void *data)
33{
Vladimir Serbinenko4b5012a2013-11-26 22:07:47 +010034 struct vsnprintf_context *ctx = data;
35 if (ctx->buf_limit) {
36 *ctx->str_buf = byte;
37 ctx->str_buf++;
38 ctx->buf_limit--;
39 }
Stefan Reinauer52fc6b12009-10-24 13:06:04 +000040}
Patrick Georgi736221f12009-05-26 14:31:37 +000041
Vladimir Serbinenko4b5012a2013-11-26 22:07:47 +010042static int vsnprintf(char *buf, size_t size, const char *fmt, va_list args)
Stefan Reinauer52fc6b12009-10-24 13:06:04 +000043{
Eric Biederman8ca8d762003-04-22 19:02:15 +000044 int i;
Vladimir Serbinenko4b5012a2013-11-26 22:07:47 +010045 struct vsnprintf_context ctx;
Stefan Reinauer52fc6b12009-10-24 13:06:04 +000046
Rudolf Marek7f0e9302011-09-02 23:23:41 +020047 DISABLE_TRACE;
Stefan Reinauer52fc6b12009-10-24 13:06:04 +000048
Vladimir Serbinenko22676582013-11-26 21:48:57 +010049 ctx.str_buf = buf;
Vladimir Serbinenko4b5012a2013-11-26 22:07:47 +010050 ctx.buf_limit = size ? size - 1 : 0;
Vladimir Serbinenko22676582013-11-26 21:48:57 +010051 i = vtxdprintf(str_tx_byte, fmt, args, &ctx);
Vladimir Serbinenko4b5012a2013-11-26 22:07:47 +010052 if (size)
53 *ctx.str_buf = '\0';
Stefan Reinauer52fc6b12009-10-24 13:06:04 +000054
Rudolf Marek7f0e9302011-09-02 23:23:41 +020055 ENABLE_TRACE;
Stefan Reinauer52fc6b12009-10-24 13:06:04 +000056
Eric Biederman8ca8d762003-04-22 19:02:15 +000057 return i;
58}
59
Vladimir Serbinenko4b5012a2013-11-26 22:07:47 +010060int snprintf(char *buf, size_t size, const char *fmt, ...)
61{
62 va_list args;
63 int i;
64
65 va_start(args, fmt);
66 i = vsnprintf(buf, size, fmt, args);
Eric Biederman8ca8d762003-04-22 19:02:15 +000067 va_end(args);
Stefan Reinauer52fc6b12009-10-24 13:06:04 +000068
Eric Biederman8ca8d762003-04-22 19:02:15 +000069 return i;
70}