78 lines
1.4 KiB
C
78 lines
1.4 KiB
C
/*
|
|
* Copyright (C) 2018 Intel Corporation. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <hypervisor.h>
|
|
|
|
static int charout(int cmd, const char *s_arg, uint32_t sz_arg, void *hnd)
|
|
{
|
|
const char *s = s_arg;
|
|
uint32_t sz = sz_arg;
|
|
/* pointer to an integer to store the number of characters */
|
|
int *nchars = (int *)hnd;
|
|
/* working pointer */
|
|
const char *p = s;
|
|
int len;
|
|
|
|
/* copy mode ? */
|
|
if (cmd == PRINT_CMD_COPY) {
|
|
if (sz > 0U) { /* copy 'sz' characters */
|
|
len = console_write(s, sz);
|
|
s += len;
|
|
}
|
|
|
|
*nchars += (s - p);
|
|
} else {
|
|
/* fill mode */
|
|
*nchars += sz;
|
|
while (sz != 0U) {
|
|
console_putc(s);
|
|
sz--;
|
|
}
|
|
}
|
|
|
|
return *nchars;
|
|
}
|
|
|
|
int vprintf(const char *fmt, va_list args)
|
|
{
|
|
/* struct to store all necessary parameters */
|
|
struct print_param param;
|
|
/* the result of this function */
|
|
int res = 0;
|
|
/* argument fo charout() */
|
|
int nchars = 0;
|
|
|
|
/* initialize parameters */
|
|
(void)memset(¶m, 0U, sizeof(param));
|
|
param.emit = charout;
|
|
param.data = &nchars;
|
|
|
|
/* execute the printf() */
|
|
res = do_print(fmt, ¶m, args);
|
|
|
|
/* done */
|
|
return res;
|
|
}
|
|
|
|
int printf(const char *fmt, ...)
|
|
{
|
|
/* variable argument list needed for do_print() */
|
|
va_list args;
|
|
/* the result of this function */
|
|
int res;
|
|
|
|
va_start(args, fmt);
|
|
|
|
/* execute the printf() */
|
|
res = vprintf(fmt, args);
|
|
|
|
/* destroy parameter list */
|
|
va_end(args);
|
|
|
|
/* done */
|
|
return res;
|
|
}
|